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Abstract 


A  Multiple  Model  Adaptive  Estimation  (MMAE)  algorithm  is  applied  to  the  Variable  Stability  In-flight 
Simulator  Test  Aircraft  (VISTA)  F-16  at  a  low  dynamic  pressure  flight  condition  (0.4  Mach  at  20000  ft).  A 
complete  F-16  flight  control  system  is  modeled  containing  the  longitudinal  and  lateral-directional  axes.  Single 
and  dual  actuator  and  sensor  failures  are  simulated  including;  complete  actuator  failures,  partial  actuator  failures, 
complete  sensor  failures,  increased  sensor  noise,  sensor  biases,  dual  complete  actuator  failures,  dual  complete 
sensor  failures,  and  combinations  of  actuator  and  sensor  failures.  Failure  scenarios  are  examined  in  both 
maneuvering  and  straight  and  level  flight  conditions.  The  system  performance  is  characterized  when  excited 
by  purposeful  commands  and  dither  signals.  Single  scalar  residual  monitoring  techniques  are  evaluated  with 
suggestions  for  improved  performance.  A  Kalman  filter  is  designed  for  each  hypothesized  failure  condition. 
In  this  thesis,  thirteen  elemental  Kalman  filters  are  designed  encompassing:  a  no  failure  filter,  left  stabilator 
failure  filter,  a  right  stabilator  failure  filter,  a  left  flaperon  failure  filter,  a  right  flaperon  failure  filter,  a  rudder 
failure  filter,  a  velocity  sensor  failure  filter,  an  angle  of  attack  sensor  failure  filter,  a  pitch  rate  sensor  failure 
filter,  a  normal  acceleration  sensor  failure  filter,  a  roll  rate  sensor  failure  filter,  a  yaw  rate  sensor  failure  filter, 
and  a  lateral  acceleration  sensor  failure  filter.  The  Bayesian  Multiple  Model  Adaptive  Estimator  (MMAE) 
algorithm  blends  the  state  estimates  from  each  of  the  filters,  representing  a  hypothesized  failure,  multiplied  by 
the  filters  computed  probability.  The  blended  state  estimates  are  sent  to  the  VISTA  F-16  flight  control  systeia 
A  hierarchical  "moving  bank"  structure  is  utilized  for  multiple  failure  scenarios.  Simultaneous  dual  failures  are 
included  within  the  study.  White  Gaussian  noise  is  iiKluded  to  simulate  the  effects  of  atmospheric  disturbances, 
and  w  hite  Gaussian  noise  is  added  to  the  measurements  to  simulate  the  effects  of  sensor  noise.  Each  elemental 
Kalman  filter  is  compared  to  the  truth  model  with  a  selected  failure.  Rlters  with  residuals  that  have  mean 
square  values  most  in  consonance  with  their  internally  computed  covariance  are  assigned  the  higher  probabihties. 


APPENDIX  A:  ADDITIONAL  RESULTS  FOR  FAILURES 


This  appendix  contains  the  remainder  of  the  multiple  failure  data  not  presented  within  Chapter  4.  The  data 
is  organized  similar  to  Chapter  4.  All  of  the  data  presented  within  this  appendix  is  for  hard  actuator  and  sensor 
failure  combinations.  Figures  A.l  through  A.6  present  the  remainder  of  the  data,  not  presented  in  Chapter  4, 
for  the  second  subliminal  dither  signal.  Figures  A.7  through  A.  13  present  data  for  a  sinusoidal  dither  signal. 
Figures  A. 14  through  A.20  present  data  for  a  purposeful  roll  command.  Figures  A.21  through  A.29  present  data 
for  a  purposeful  roll  and  pull  command.  Figures  A. 30  through  A.43  present  data  for  a  puqx)seful  rudder  kick 
and  hold.  Preceding  each  of  set  of  figures  is  a  two  page  Fortran  description  of  the  command  input  Note 
sections  of  the  code  are  commented  out  depending  on  the  signal  implemented.  This  allows  the  reader  to 
evaluate  the  command  signal's  relative  timing  and  magnitude. 
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APPENDIX  B:  VISTA  F-16  SIMULATION 
VERIFICATION  RESUl  TS 


The  VISTA  F-16  simulaboD  developed  for  this  research  effort  was  validated  using  the  GENESIS  simulation. 
The  GENESIS  simulation  resides  in  the  Flight  Dynamics  Laboratory  at  Wright-Patterson  Ara,  OH.  The 
GENESIS  simulation  is  a  nonlinear  six-degiee-of-fieedom  simulation.  The  GENESIS  code  allows  the  user  to 
to  run  a  simulation  using  the  non-linear  aerodynamic  model  or  an  aerodynamic  model  linearlized  about  a  trim 
point.  The  code  produces  laser  quality  traces  of  any  simulation  variables.  The  code  also  allows  the  examination 
of  internal  flight  control  system  variables  at  any  time  in  the  simulation.  The  aerodynamic  model  used  in  the 
thesis  cfTon  was  a  model  linearized  about  the  trim  point  of  0.4  Mach,  20000  ft. 

The  flight  control  system  was  checked  by  applying  the  linearized  aerodynamic  data  base  from  the  GENESIS 
simulation.  After  the  open  loop  flight  control  system  was  checked  out,  the  system  was  mn  in  the  closed  loop 
mode  with  the  linearized  aerodynamic  data  base.  These  plots  are  shown  in  Figures  B.I  -  B.17.  For  the  8 
second  time  plots,  the  conelatioa  is  very  good.  Differences  in  the  simulation  are  due  to  the  comparison  of  a 
linear  and  nonlinear  data  base  and  the  result  of  modeling  the  flight  control  system  without  the  higher  order 
dynamics  (above  40  rad/sec).  Actuator  models  were  checked  separately  by  evaluating  each  of  the  models  with 
theoretical  predictions  and  varying  sample  rates.  The  integration  routine  DEABM  was  evaluated  with  a 
comparison  of  results  from  a  fast-sampling  simple  Euler  integration  program.  The  test  were  conducted  on  the 
4th  order  acutator  models.  The  results  verifed  the  integration  routines  and  demonstrated  that  the  rate  limiting 
functions  were  correctly  modeled  within  the  EOM  subroutine  (Figure  B.I).  Figure  B.2  demonstrates  the  pitch 
command  used  to  evaluate  the  coded  flight  control  system  at  the  0.8  Mach,  10000  ft  test  case  (high  dynamic 
pressure  case  tested  by  Stratton  (13].  The  command  is  a  simple  pitch  puU  and  bold  of  10  lbs  for  a  duration  of 
2  seconds.  Figure  B.3  demonstrates  the  results  of  the  simulation  as  compared  to  the  GENESIS  nonlinear 
simulation.  The  GVTRL  subroutine,  developed  for  this  thesis,  is  the  line  which  contains  plotted  data  points. 
From  Figure  B.3,  the  Mach  or  velocity  data  demonstrates  a  marginal  match.  Figure  B.4  presents  the  normal 
acceleration  trace  as  a  function  of  time.  Comparision  of  the  two  plots  yields  small  mismatches  at  2.0  and  3.0 
seconds.  Figure  B.5  presents  the  angle  of  attack  as  a  fuiKtion  of  time.  Comparision  of  the  data  demonstrates 
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exccHcnt  results.  Figure  B.6  displays  tbe  pitch  angle  with  time.  Again,  comparision  of  the  data  demonstrates 
excellent  results.  Figure  B.7  deirwnstrates  the  pitch  rate  as  a  function  of  time.  Very  small  mismatches  occur 
near  the  relative  minima  aixl  maxima  of  the  traces.  Overall  tbe  correlation  is  very  good.  Figures  B.2  through 
B.7  presented  data  for  a  10  lb  pull  and  bold  for  a  duration  of  2.0  seconds.  The  10  lb  pull  was  chosen  to 
exercise  the  simulation  without  violating  tbe  small  angle  criteria  and  to  maintain  linear  assumption  validity.  The 
next  verification  case  demonstrates  a  29  lb  pull  and  bold  at  0.8  Mach  aiKl  10000  ft  Figure  B.8  demonstrates 
the  Mach  number  as  a  function  of  time.  Tbe  data  for  the  CNTRL  subroutine  was  not  plotted  beyond  5  seconds 
since  it  is  clear  that  the  velocity  has  diverged  far  from  tbe  GENESIS  code.  This  divergence  is  attributed  to  tbe 
simple  drag  model  used  within  tbe  linear  model.  Figure  B.9  demonstrates  the  Normal  Acceleration  (in  fl/sec^) 
vs  time.  Tbe  plots  are  comparable  until  about  2  seconds.  Figure  B.IO  displays  the  angle  of  attack  for  this  test 
case.  Again,  a  divergence  between  the  curves  occurs  at  approximately  2.0  seconds.  Figure  B.l  1  presents  tbe 
data  for  the  pitch  angle.  While  the  rate  of  divergence  is  smaller,  divergence  is  present  Figure  B.l 2 
demonstrates  the  pitch  rate  as  a  function  of  time.  The  curves  are  comparable  through  the  first  transient 
(approximately  1.8  seconds).  Figures  B.8  though  B.12  were  presented  to  provide  a  boundary.  Figures  B.2 
through  B.7  provided  an  operating  condition  and  Figures  B.8  through  B.12  provided  tbe  reader  with  an 
expectation  of  performance  degradation  for  venturing  too  far  from  that  operating  condition.  Figure  B.l 3 
provides  data  for  a  29  lb  longitudinal  stick  pull  and  bold  for  0.4  Mach  at  2(X)00  ft.  While  the  Mach  is  slightly 
biased,  tbe  curve  is  reasonably  close  to  tbe  GENESIS  data.  Figure  B.l 4  denxrnstrates  tbe  altitude  as  a  function 
of  time.  Tbe  altitude  is  20  ft  in  error  after  4.0  seconds.  Figure  B.15  demonstrates  tbe  angle  of  attack  as  a 
function  of  time.  Tbe  results  are  reasonably  close  up  to  3.0  seconds.  The  general  shape  of  tbe  curve  appears 
correct.  Figure  B.16  demonstrates  the  pitch  angle  with  time.  Tbe  results  are  within  1  degree  after  3  seconds 
and  4  degrees  after  4  seconds.  Tbe  bounds  for  tbe  0.4  Mach  at  20000  ft  case  are  considerably  better  than  tbe 
0.8  Mach  at  10000  ft  case.  This  is  true  for  the  operating  conditions  as  well.  Figure  B.l 7  demonstrates  the  open 
loop  check  out  of  the  CNTRL  code  with  tbe  GENESIS  code.  Tbe  nonlinear  data  base  was  transferred  and  input 
into  tbe  CNTRL  subroutine  as  tbe  input  data.  Figure  B.17  demonstrates  the  effect  of  not  including  tbe  higher 
order  dynamic  terms. 

In  this  thesis  the  majority  of  the  identificatioo  effort  was  done  with  imderate  magnitude,  small  time  duration 
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ditber  signals.  A  comparisoo  with  the  GENESIS  code  should  produce  neariy  identical  results.  The  purposeful 
commands  are  the  exception  to  the  rule.  A  few  purposeful  commands  resulted  in  pitch  angles  of  over  30 
degrees  after  8  seconds.  The  majority  of  commands  are  within  the  small  angle  constraints  and  near  the  trim 
conditions. 
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APPENDIX  C:  MMAESIM  COMPUTER  CODE 


The  MMAESIM  computer  code  is  divided  into  subroutines  as  shown  in  Figures  C.l  -  C.8.  This  appendix 
will  functionally  describe  each  subroutine.  The  Fortran  code  is  included  at  the  end  of  this  appendix.  The 
appendix  will  also  describe  any  supporting  routines  which  are  necessary  or  helpful  in  the  execution  of  this 
research  project. 

Figure  C.  1  presents  the  MMAESIM  fault  detection  and  isolation  model  key.  This  figure  provides  the  filter 
names  and  their  corresponding  descriptions.  Filters  FOIXX,  F02XX,  and  P03XX  are  always  the  truth  models 
for  the  three  successive  time  intervals  in  the  simulation  (no  failure,  first  failure,  second  failure).  Filter  P04XX 
is  always  the  fully  functional  filter.  The  last  two  letters  in  the  filter  designation  provide  the  bank  location  (Bl- 
B9,and  then  X0-X3,  necessary  because  of  two  letter  constraint).  The  MMAESIM  program  is  the  first  block  in 
Figure  C.2.  This  code  is  responsible  for  the  proper  execution  of  the  subroutines.  Figure  C.3  demonstrates  the 
block  diagrams  for  the  GETDAT  and  GAUSSGEN  subroutines.  Figure  C.4  presents  the  Kalman  filter 
subroutine,  KFILT,  block  diagraia  Figure  C.5  presents  the  UPDATE  and  ADPCON  subroutine  block  diagrams. 
Figure  C.6  displays  the  VISTA  F-I6  flight  control  system  block  diagram  (CTNTRL).  The  integration  subroutine, 
DEABM,  block  diagram  is  shown  in  Figure  C.7.  Figure  C.8  presents  the  equations  of  motion  subroutine,  EOM, 
block  diagram.  The  FORTRAN  code  is  included  following  the  figures.  The  FORTRAN  code  for  the  VISTA 
F-16  flight  control  system  is  not  included  because  of  limited  distribution  rights. 
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MMAESIM 

FAULTDETECnONSiSOLATtON MODEL  KEY 


F01B1  -  FULLY  FUNCTIONAL  TRUTH  MODEL 
F02B1  -  FIRST  FAILURE  TRUTH  MODEL 
F03B1  -  DUAL  FAILURE  TRUTH  MODEL 

F0AB1  -  FuLLYFUNcflbNAL^^^ 

F05B1  -  LEFT  STABILATOR  FAILURE 

F06B1  -  RIGHT  STABILATOR  FAILURE 

F07B1  -  LEFT  FLAPERON  FAILURE 

F08B1  -  RIGHT  FLAPERON  FAILURE 

F09B1  -  RUDDER  FAILURE 

FI  OBI  -  VELOCITY  SENSOR  FAILURE 

F11B1  -  ANGLE  OF  ATTACK  SENSOR  FAILURE 

F12B1  -  PITCH  RATE  SENSOR  FAILURE 

F13B1  -  NORMAL  ACCELERATION  SENSOR  FAILURE 

F14B1  -  ROLL  RATE  SENSOR  FAILURE 

F15B1  -  YAW  RATE  SENSOR  FAILURE 

F16B1  -  LATERAL  ACCELERATION  SENSOR  FAILURE 


C.l  KMACSIM  fault  d«t«ctlc>n  and  laolatloo  aodal  kay 
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MMAESIM  BLOCK  DIAGRAM 
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nkaesin  block  dlagraa 


and  OMSSCMl  awbreutlaa  Meok  dtavri 


KRLT 
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aoPCON  and  OPOAT*  aubroutina  block  dla9ii 


non  n  o  ono  n  o  n  on  n  o  n  n  o  o  o  o  r>  o  o  n  o  n  n  o  n  o  o  n  o  r>  o  o  o  o  o  o  n  o 


PROGRAM  HMAESIH 


AIR  FORCE  INSTITUTE  OF  TECHNOLOGY 
Department  of  Electrical  and  Computer  En9ineerln9 


EENG  799 

MULTIPLE  MODEL  ADAPTIVE  ESTIMATOR 
FOR  THE  VISTA/F-16 


by 

Captain  Gre9ory  L.  Stratton 
and 

Mr.  Tim  Menke 


This  pro9ram  is  a  simulation  to  evaluate  a  multiple  model 
adaptive  estimator  wrapped  around  the  actual  General  Dynamics 
VlSTA/F-16  controller  (based  on  the  GD  VlSTA/F-16  block  dia9ram 
and  as  coded  in  FORTRAN  by  Mr.  Tim  Menke).  This  program  is 
based  on  the  program  MMACSIM.  The  original  authors  of  MMACSIM 
are : 

Captains  Donald  Pogoda  and  Gregory  Gross,  Version  1 
Captain  Richard  Stevens,  Version  3 

Last  Revision:  September  1969,  MMAESIM  Version:  1 


include  variable  declaration  file 
INCLUDE  ’DECLARR.TXT' 


local  variables 


REAL  T,TOUT,XIC(29) ,Y(29),V(7),W(8),NOISE(8) 
REAL  DEGRAD,ZTPART(7),X(29),DX(29) 

INTEGER  I,J,jk,klm 

INTEGER  II , JJ, IX, JX, IZ, JZ, lA, IB, IQ, IDX 
INTEGER  tempat , tempbt , tempct , tempdt 
CHARACTER* 1  NFI LET , MFI LET, OFI LET, NYFI LET 
CHARACTER* 3  NXFILET 
CHARACTER*4  NWFILET 
CHARACTER*S  DFILET 


INTEGER  L,ti,Bankold,ij,i r , pull  flag, count 
REAL  Prbavg( 20) ,tswitch,Probs2( 10,20) 

INTEGER  SMPON,SMPOFF 
REAL  TIMON,TIMOFP 

declarations  for  DEABM 

INTEGER  IDID,  IPAR,LIH,LRH,INFO( 15) , IWORK(50) 
REAL  ATOL,RPAR,RTOL,RWORK(739) 


C-10 


uo  ou  o  u  u  u  uuu  uuo  uuu  u u u u u u o u u u u u u 


dtclaratlona  for  coda  chackln9  al9oritha 

REAL  haaydua(7 ,8 ) ,xaaydu*(8, 1 ) , taayatatt 7 ,1 ) 

REAL  haaycon( 7, 21 ) . xaaycon( 21 , 1 ) , l■aycon( 7, 1 ) 

EXTERNAL  EON 

OPEN (UN IT- 17, PILE- 'TROTH. DAT' .STATUS- 'UNKNOWN' ) 

0PEN(UNIT-18,PILE-'CHECKER.DAT' , STATUS- ' UNKNOWN' ) 

0PEN(UNIT-19,PILE-'PILTER.DAT' .STATUS-'UNKNOWN' ) 
OPEN (UNIT-SI, PILE- 'PROBZZ.DAT' , STATUS- ' UNKNOW' ) 

0PEN(UNIT-S2, PILE- 'PROBZZ2.DAT' , STATUS- ' UNKNOWN' ) 

6pEN(UNIT-7lipiLE-'HXx!oAT'  ,5TATUS-'UNKN^'  ') 
OPEN(UNIT-72,"pILE-'HXm!dAT'  .STATUS-'UNKNOWN'  j 


START  PROGRAM 


pi-3.1415926S4 
da9rad-pl/180. 
bankf la9-0 

CALL  TIME(CTIHB) 
CALL  DATE (COATE) 


Brln9  In  tha  data  for  tha  truth  Bodal(a)  and  tha  controllara. 


CALL  GETOAT 


-  Coaputa  tha  atoppino  aaapla  nuabar  for  tha  DSIN  provldad  in 

tha  REALS. OAT  data  Input  flla. 

Also  aat  tha  start  and  stoppin9  tlaea  usad  to  stora  tha 
llkllhood  Inforaatlon.  Nota  that  only  3  aaconda  (192  aaaplaa 
basad  on  64  Hs  aaapla  rata)  can  ba  saved  at  a  tiaa.  This  is 
to  keep  tha  array  size  of  LKH  down  to  a  Bana9ablo  level  (even 
as  it  is,  the  array  is  192  rows  x  91  coluans  -  17,472.  If  tha 
oivan  on  and  off  tiaas  result  in  an  on  and  off  saapla  incraaant 
diffaranca  of  9raatar  than  192,  than  tha  off  saapla  incraaant 
is  adjusted  so  that  it  is  equal  to  the  on  saapla  incraaant  plus 
192. 


SHPLS-DSIH/TSAMP 

1  START— 1 

ISTOP-IPIX(SHPLS)^l 
TIMON  -  4.0 
TIHOPP  -  7.0 

SHPON  -  1P1X(T1N0N/TSAMP)'»1 
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SMPorr  -  irix(TiMOPr/TSA>«p)  +  l 

IP(  (SHPOPP-SMPON)  .GT.192)  SHPOPP  -  SHPON4^192 


C««***********>*****k*. **•*•*••*••**••**•***••*••*. **•*****«. .*.**..* 

C  -  X*cc  out  th«  storag*  areas  for  the  states,  the  Inputs, 

C  the  elenental  controller  probabilities,  the  control  surface 
C  deflections,  the  output  vector,  and  the  accelerations. 

C  Bach  of  arrays  keeps  a  running  total  of  their  respective  values 
C  through  all  of  the  aonte  carlo  loops.  After  the  aonte  carlo 

C  loop  run  is  coaplete,  each  of  the  arrays  are  noraalised  by  the 

C  the  nuaber  of  aonte  carlo  loops,  XITER. 

C  Also  zero  the  tiae  vector  used  for  plotting,  TVEC. 

C»  ****•**•**»»**»»*»*»***» 

DO  751  JJ-1,10 
DO  750  11-1,513 

IP  (JJ.BQ.l)  THEN 
TVEC( 

IP  (II.LE.192)  TSHORT( II, JJ)-0. 

END  IP 

IP  (JJ.le.B)  STATES! II, JJ)-0. 

IP  (JJ.le.6)  THEN 
INPUTS! II ,JJ)-0. 

DEPLBC! II , JJ)-0. 

END  IP 

PROBS! II ,JJ)-0. 

IP  !JJ.LE.7)  PROBS!II,JJ+10)-0. 

OUT!II,JJ)-0. 

OUT!II,JJ^l0)-0. 

IP  !JJ.LE.9)  OUT!II,JJ+20)-0. 

IP!JJ.LE.2)  ACCEL! II, JJ)-0. 

750  CONTINUE 

751  CONTINUE 


C  Create  the  C  aatris.  It  is  just  a  29  by  29  identity  aatrix. 


DO  JJ-1,29 
DO  11-1,29 

IP  !JJ.EQ.II)  THEN 
C! II,JJ)-1 .0 
ELSE 

C! II , JJ)-0.0 
END  IP 
END  DO 
END  DO 

C$S$$$$S$$S$S$$S$S$$$$5$$$$$$$$SS$$$$$S$$$$$S$SSSS$$$S$$$$S$$$SSS$$$$S$SS$ 

CSS$S$SS$SS$SSS$SSSSSS$$SS$$S$S$SSSSSSS$$$SS$$$$SS$$$S$$$$5$S$$SS$$$$$$S$$ 

c* ••**•••••••*•••**•••«•••*•**•*•***•***••••••••«•••••*••*•***•••***•* 

c 

C  This  is  the  Honte  Carlo  Slaulation  Loop,  !to  stateaent  760.) 

C 

. . . . 


DO  780  IJK-1, XITER 
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949  MObrmC-  MOML  CSTtMAT tom  AMOt 

f-l<  WITH  ACTUATOff  AMO  SCMSOM  FAILUAfS  UOLUMC  2<U>  AIM 
FOMC€  IMS!  Of  TMCM  MM IdMI-AATTMASOM  AM6  OM  SCNOOL  Of  MM 
UMCLASSIFIMO  T  €  MMMMM  1  JUM  92  AM I r/OA/MMG/92J-Oi 


oooooooo  o  o  r>  n  n  n  nnn  nnnnn  ooo 


WRITE(»,*)'  MONTE  CARLO  LOOP  •  ',1JR 


INITV-1 

Initv2>0 

NOOELN-aod«lnl 


-  G«t  th«  fully  functional  aircraft  truth  aodal  aatricas. 


CALL  PULLOUT 


-  Zaro  out  29-dlBansional  X-vactor  a  AUNEW.  Alto,  inltialtsa 

tha  20-diBanalonal  (aavantaan  flltars  plus  thraa  truth  aodala.) 
PRBNEW  vactor. 


DO  1010  I-1.29 
X(I)-0.0 

1P( I .LB.6)AUNEH(I)-0.0 
IP  (I. la. 20)  THEN 

IP  ( ( I  .na.Bodalnl)  .and.  ( I  .na .■odaln2 ) 

*  .and.  ( I .na .aodalnJ ) )  THEN 

PRBNEWC I,Bank)-(l.-PRBPLTRTO)/fLOAT(NPLTR(Bank)-4) 
If  (I.EQ.PLTRTO)  PRBNBW(I.Bank)-PRBrLTRTO 


END  IP 
END  If 
1010  CONTINUE 


—  Initiallaa  Olffarential  Equation  Solvinq  Routlna  (DEABM) 


1NPO(1)-0 
INro(2)«0 
INPO( 3)-0 
lNrO(4)-l 
LRW-739 
LIH-50 
RTOL-l.E-08 
RTOL-1 .E-10 
ATOL-1 .E-07 
ATOL-I.E-09 
T-0.0 
TOUT- 0.0 


-  Thla  if  tha  start  of  tha  tiaa  rasponsa  loop  (to  statenant  300.) 


DO  300  J-ISTART,ISTOP 


-  Chack  to  aaka  sura  wa  hava  tha  corract  truth  aodal. 

-  If  no  failuras  ara  bainq  aodalad  (nuafails-O)  than  tha  fully 

functional  aircraft  truth  Bodal  (aodalnl)  ia  always  usad. 

-  If  ona  failura  is  baing  aodalad  (nuafails-l)  than  tha  fully 

functional  aircraft  aodal  (aodalnl)  is  usad  froa  tiaa  saro  to 
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'iaela9l.  At  tlaela9l,  th«  truth  aodtl  balna  uaad  chan9«(  to 
tha  Bln9la  Inducad  failura  truth  aodal  (■odaln2). 

-  If  two  failuras  ara  balna  aodalad  (nuHfailt>2)  than  tha  fully 

functional  aircraft  modal  (modalnl)  ia  uaad  from  tlma  xaro  to 
tlBala9l.  At  tlBala9l,  tha  truth  modal  balna  uaad  chan9aa  to 
tha  aln9la  Inducad  failura  truth  modal  (modaln2).  At  tlmalaa2, 
tha  truth  modal  baln9  uaad  chan9aa  to  tha  doubla  Inducad  failura 
truth  modal  (modalnS). 

-  Tlmala9l  muat  ba  laaa  than  or  aqual  to  tlBala92. 

-  Nota  that  PULLOUT  la  callad  only  whan  HODCLN  chan9aa. 


IP  (numfalla.aq.O)  THEN 
IP( lactfl2.aq.6)THEN 

IP  ( tout.9a.tlmala92)  THEN 
IP  (MODELN.na.modalnS)  THEN 
HOOBLN«>modeln3 

wrlta( *,*)' truth  modal  •  ',M0DELn3 
CALL  PULLOUT 
END  IP 
END  IP 
ENDIP 

ELSE  IP  ( numfaila .aq. 1 )  THEN 

IP  ( ( tout . 9a. tlmalaqi )  .and.  (HODELN.na.modeln2) )  THEN 
MODELN-modeln2 
CALL  PULLOUT 
END  IP 

ELSE  IP  (numfaila. aq. 2)  THEN 

IP  ( (tout.qa.tiaalaql )  .and.  ( tout . It . tlaala92 ) )  THEN 
IP  (HODELN.na.aodaln2)  THEN 
NODELN-aodaln2 
CALL  PULLOUT 
END  IP 

ELSE  IP  (tout.9a.tlaela92)  THEN 
IP  (HODELN.na.aodaln3)  THEN 
NODELN-aodaln3 

wrlta(*,»)'truth  modal  -  ',HODELn3 
CALL  PULLOUT 
END  IP 

END  IP 

END  IP 

///////////////////////////////////////// 

CODE  CHECK 

///////////////////////////////////////// 

IP( (T.GE. 3.0) .AND. (T.LE. 3. 3) )THEN 
WFITE(18,*) 'TRUTH  MODEL  AT  TIME',T 
WRITE(18,*)'HT  ',HT 
WRITE(18,*)'H' ,R 

WRITE( 18,e ) 'X' ,X 
ENDIP 


-  Create  Output  Vector,  Y.  (Y»CX) 


CALL  MATML(C,X,Y,29,29,1) 


-  Create  tha  time  vector  uaad  for  plottlnq  purpoaaa,  TVEC 
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And  cctata  th«  short  tias  vsctor,  TSHORT 


C* **•***«*•*****•••****•*••*•*••••****•*••*•*******• 

xr  (IJK.BQ.l)  THEN 
TVEC( J,l)-TOUT 

IP  ( ( J.GE.SHPON) .AND. ( J.LT.SMPOPP) )  THEN 
TSHORT( J-SNPON+l , I ) -TOOT 
END  IP 
END  IP 

C* *•***•••**•**•****•***•*•**•**••**«•«**•*****•**** 

C  -  Coaputs  Tias  Retponss  for  Systsa  Outputs. 

C***********.*************************************** 

DO  876  kla-1,29 

OUT( J,kla)-Y(kla)+OUT( J.kla) 

876  CONTINUE 


C  -  Coaputs  Tias  Rssponss  for  Control  Inputs  snd  Dsflsctions. 

. . . 

DO  76S  kla-1,6 

INPUTSi  J,kla) -AUNEH(kla)'f  INPUTS  (J,kla) 

DEPLECC  J,kla)«X(9'^(kla-l)*4)«OBPLEC(  J.kla) 

765  CONTINUE 

C* **•*•*******«****•«•*•*•**•**••*•* ******t*************t****** 

C  -  Coaputs  Tias  Rssponss  for  Plant  Statss. 

C********************************************. •***••*•****••**• 


DO  654  kla-1,8 

STATES( J,kla)-X(kla)«STATES( J.kla) 
654  CONTINUE 


C* ***•<***•*«*••*•**•***••****•*•*******«•****. *«*•****» 

C  -  Coaputs  Tias  Rssponss  of  Controllsr  Probabilitiss. 

c* **•**••••****••*••*••**•**•*•*••**•*•***••***••**•*••• 


DO  iq«l.NPLTR(bank) 

Prbavqi  iq)«iO. 

EKDDO 

DO  1771  iq-l,NPLTR(Bank) 

IP  ( ( iq.ns.aodslnl)  .and.  ( iq . ns .aodslnZ ) 

♦  .and.  (iq.ns.aodslnl))  THEN 

PROBS(  J,iq)«PROBS(  J,  iq)4^PRBNEN(  iq.Bank) 

IP(BANK.NE.1)THEN 

PRBBNK2( J, iq)-PROBS( J,  iq) 

ENDIP 

IP  (J.lt.lO)  THEN 
DO  1778  ti-2,J 

Probs2(ti,iq)-Probs2(ti-l,iq) 

1778  CONTINUE 
ELSE 

DO  1779  tl-2,10 

Probs2( ti , iq)«Probs2( ti-1 ,  iq) 

1779  CONTINUE 
END  IP 

Probs2( 1 , iq)»Prbnsw( iq,bank ) 

IP  (j.qt.lO)  THEN 
DO  1776  ti-1, 10 


C-15 


oonoo  o  ooorio  non 


Pcb«v9( lq)«Prbavg( lq)4Probt2( ti , Iq) 
1776  CONTINUB 

PrbavqC lq)-prbav9( lq)/10.0 
END  IP 


END  IP 


1771  CONTINUE 


—  Increaant  th«  ti**  by  on*  taapla  tlaa 


TOUT  -  TOUT  ♦  TSAMP 


Pallura  Saction  -  Zaro  out  tha  fallad  actuator  atataa  for  tha 
propar  fallura  at  tha  corract  tlaa  (currantly  aat  up  for  a 
slnqla  fallura  scanarto 


wrlta( * , * )  tout.nuafailt, iactfall 
IP  ( (nuafailt.aq.l) .OR. (nuBfailt.aq.2) )  THEN 


IP  (tout.qa.tiaalagl)  THEN 
IP  ( iactfail .aq . 1 ) than 
X(9)-0.0 

ELSE  IP  (Iactfail. aq.2)than 
X(13)-0.0 

ELSE  IP  (iactfail. aq.3)than 
X(17)-0.0 

ELSE  IP  (iactfail. aq.4)than 
X(21)-0.0 

ELSE  IP  (iactfail. aq.5)than 
x(2S)-0.0 
ENOIP 
ENDIP 

IP  (tout.9a.ti«ala92)  THEN 
IP  ( iactfl2.aq.l}than 
X(9)-0.0 

ELSE  IP  (iactfl2.aq.2)than 
X(13)-0.0 

ELSE  IP  (iactfl2.aq.3)than 
X(17)-0.0 

ELSE  IP  (iactfl2.aq.4)than 
X(21)-0.0 

ELSE  IP  (iactfl2.aq.S)than 
X(25J-0.0 

ELSE  IP  ( iactfl2.aq.6)than 

conditions  hava  changad  no  fallura  is 
preaant.  This  daaonatratat  tha  capability 
of  tha  algoritha  to  back  out  of  tha  banks 

nuafails  •  d 

c  writa(*,«) 'through  gats  11  '.tout 


ENDIP 


ENOIP 

ENDIP 
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- Crcatt  a  nolsa-fraa  Maasuraaent  vactor  Z«i(HX)  and  than  add 

■aaturaaant  nolaa  {*  R)  to  BaasuraBanta .  Subroutina  Cauasgan 
ganarataa  a  GWN  vactor  of  langth  aavan. 

-  If  aanaorblaa  ia  1,  a  aanaor  blaa  will  ba  alBulatad.  Tha  tara 

abiaaaant  ia  addad  to  tha  aaaauraaant  vactor.  Tha  aanaorbiaa 
flag  and  abiaaaant  vactor  ara  dafinad  in  tha  input  fila. 


CALL  MATML(HT,X,ZTPART,7,29,1) 

///////////////////////////////////////// 

CODE  CHECK 

///////////////////////////////////////// 

If ( (T.GE.3.0).AND.(T.LE. J.3))THEN 
HRITE(17,401)T.Z(7) 
WRlTE(18,»)'TRUTa  MODEL  AT  TIME' ,T 
WRITE(1«,»)'ZTPART  -  HT  •  X',ZTPART 
ENDir 

//////////////////////////////////////// 


CALL  GAUSSGEN(DSEED,7,V) 

DO  2S9  IDX>1,7 

Modification  to  aliainata  noiaa  in  aaaauraaant 
V(IOX)-0.0 


Z( IDX)«ZTPART( IDX) 

4  'f(SQRT(R(IDX,IDXn*V(IDX)) 

IP  ( tout .ga. tiaalagl )  THEN 

IP  ( aanaorbiaa. aq.  1 )  Z(  IDX)>Z(  IDX)«^Zbiaaaant(  IDX) 
END  IP 

259  CONTINUE 

C  ///////////////////////////////////////// 

C  CODE  CHECK 

C  ///////////////////////////////////////// 

IP( {T.CE.2.95) .AND. (T.LE. 3. 3) )THEN 
do  iaaydua»l,7 
do  jaaydua  •  1,8 

haayduai iaaydua, jBayduB)-ht( imaydua, jaay'oa) 
anddo 
anddo 

do  iaaydua  ••  1,8 

xaayduai iaaydua, 1 )»x( iaaydua) 
anddo 

Call  Natal(haaydua,xaaydua, zaayatat , 7, 8, 1 ) 
Hrita(17,*)'  Stata  portion  of  aaaauraaant  aatrix' 
Hrita(17,*)'  tiaa,  ht  ' 

NR1TE( 17,*)T,haayduB 
HRITE(17,*)'  X  ',xaayduB 
HRITE(17,*)'  a  ',xaayatat 

do  iBaydua»l,7 

do  jaaydua  •  1,21 

haayconi  iaaydua, jaaydua)>ht( iaaydua, jaaydua  *  8) 
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tnddo 
•  nddo 

do  iaaydua  «  1.21 

xaayconC Isaydua, 1 )-x( laaydua  *  S) 

•nddo 

wclt«(17,*)'  Controllar  portion  of  ■•asureaent  aatcix' 
wrlt*(17,*)'  tla«,  ht' 

Call  Hatal (haaycon. xaaycon,  xaaycon, 7 ,21,1) 

HRITB(17,*)T,haaycon 

MR1TE(17,*)'  X  '.xaaycon 

HRITE(17,*)'  a  '.taaycon 

C  MRITE( !«,*) 'ITPART  -  HT  *  X'.ZTPART 

ENDIP 

C  //////////////////////////////////////// 

C***»t»»*»»»»*t»»t»*»»f»**»*»»»»»»*»»*»»»»f*»»f*»**»»*»***»*»*»* 

C  Sav«  th«  valuta  of  th«  noraal  and  lattral  accalcration 
C  into  ACCEL  ao  lat«r  aav*  with  a  call  to  MATSAV. 

C  Reaeabcr  that  Z(4)  and  Z(7)  auat  b«  adjusted  to  rafltct 
C  th«  true  acc«l«rationa. 

C* »»»»**•*»*»»»»»*••**»»»»»»*•»*»***»»»»»»*»»»»»»»»»*»•»»»»»**»»**» 


ACCEL  (  J .  1  )  -ACCEL(  J .  1 )  +Z  (  4  )  'f  1 
ACCEL(  J,2)-ACCEL(  J.2)-»^Z(7)-SIN(X(S)  ) 


---  Call  th«  Kalaan  filtar.  (ITIHB  is  uaad  to  plot  th«  rcaldual 

tla«  aequanc*.  Sa*  aubroutlna  UPDATE  and  tha  raaidual  plotting 
portion  on  PLTLSR.) 


i tlaa«j 

CALL  KPILT(T,X,DX) 


---  Call  tha  diffarantial  aquation  aolvar. 


RWORK( 1 )-TOUT 

wrl ta( 18 , * ) ' tiaa  •  ',t,'x  bafora  daaba  ',x 
1777  CALL  DEABH(E0H,29,T,X,T0UT,INP0,RT0L,AT0L,1DID, 

>  RWORK,LRH,IHORK,LIW,RPAR,IPAR) 

INPO<1)-0 

IP  (IDID.EQ.3)  THEN 
INPO(4)-l 

END  IP 

IP  ( IDID.EQ. (-2) )  THEN 
INPO(l)-l 
GOTO  1777 
END  IP 

IP  ((IDID.LE.O)  .AND.  (IDID . NE . ( -2 ) )  )  THEN 

PRINT*, '»•••  ERROR  DETECTED  WHILE  DEABH  CALLED  •*•*' 

PRINT*,'  ERROR  CODE  -  ',IDID 
PRINT*,'  500  WORE  TINES’ 

INPO(l)  •! 

GOTO  1777 
C  GOTO  9999 

ELSE 
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INPO(1)«0 

INrO(4)-l 

BND  IP 

wrlt«( 18, * ) 'tiB«  *  aftar  daaba  ’ ,x 

T-TOUT 


-  Corrupt  tha  ayataa  with  whita  Gautaian  noita  If  HPLAG«1 


IP  (WPLAG.BQ.l)  THEM 

CALL  GAUSSGeN(DSEED,8,H) 

DO  9098  IX-1,8 
NOISE( IX)-0. 

DO  999S  JX-1,IX 

NOISE(  IX)-N0ISE(IX)4^(CQDCNT(  IX ,  JX)  *N(  JX  )  *HCNPAC  ) 
999S  CONTINUE 

X(IX)«X(IX)>NOISE(IX) 

9098  CONTINUE 

END  IP 


HIERARCHY  NODULE 


Haaaura  tha  avaraga  of  tha  last  10  saaplat  of  tha  alaaantal 
controllar  probabllltiaa.  If  tha  avara9a  la  9raatar  than  90%, 
than  daclara  that  failura  haa  occurad,  and  aova  to  tha  approprlata 
bank  to  watch  for  a  aacond  failura,  or  tha  full-function  aircraft. 


-  Only  coaputa  PRBAVG  if  wa  ara  10  or  aora  aaaplaa  into  tha  taat. 


IP  (J.lt.lO)  GO  TO  1773 


— 1--Plrat,  run  throu9h  aach  of  tha  filtara  in  tha  bank  bain9  taatad. 


DO  1773  lq-4,NPLTR(Bank) 


--2--If  PRBAVG  ia  laaa  than  90%,  do  not  awitch  banka. 


IP  (PRBAVG(lq).lt.0.90)  90  to  1773 


— 3--DO  tha  followin9  if  tha  probability  axcaada  90%. 

Cycla  throu9h  aach  of  tha  filtar  bank  naaaa  until  wa  find 
a  banknaaa  which  ia  tha  aaaa  aa  tha  filtar  which  axcaada 
tha  90%  thraahold. 


DO  1774  ir«l,nuabanka 


---  If  BANK  aquala  tha  bank  wa  ara  9oin9  to  taat,  akip  it  and 
procaad  to  tha  naxt  bank. 
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ir  (Bank.*a. Ir)  GO  TO  1774 

Writ«(*,*)afll*(iq>bank),  Banknaaa( ir ) , tout .nuafalla 

C  /////////////////////////////////////////////////////////////////// 

C  -  Thla  aubsactlon  of  coda  converts  the  bank  in  dfile  to  the 

C  correct  proper  bank  nuaiber  for  switching  banks 
C  ////////////////////////////////////////////////////////////////// 

oriLET  -  dfile(iq,bank) 

NriLBT-DPILET(2s2) 

HP1LET-DPILET( 3: 1) 

TEMPAT  -  ICHAR(NriLET)  -  4S 
TEMPBT  •  1 CHAU (HP I LET)  -  48 
TEMPCT  -  TEMPAT»10  ♦  TEMPBT 
TEMPDT  -  TEMPCT 

IP(TEHPCT.LE.12)THEN 
TEMPCT  -  TEMPCT  -  3 
ELSE 

TEMPCT  -  TEMPCT  -  3 
ENDIP 

WR1TE( *, •)NPI LET, MPI LET, TEMPAT, TEMPBT,  TEMPCT 

NWPILET  -  DPILET 
NXPILET  -  DPILET 
OPILET  -  CHAB(TEMPCT  ♦  48) 

WRITE(*,*)OPILBT 

IP(TEMPDT.LE.12)THEN 

dfilet  •  nwf iiet//of ilet 
ELSE 

nyfilet  - 

dfilet  «  nxfilet//nyf llet//of ilet 
ENDIP 

write(*,*)dfllet 

C  /////////////////////////////////////////////////////////////// 

IP  ( DPILE( iq, teapct ) . eq. BanknaMe( ir ) )  THEN 
Bankold-Bank 
Bank-i r 

Bankf  lag^Bankf  lag'fl 
PRINT*,'  ' 

NRITE(*,9700)  Dfile(lq,bankold),Ofile(iq,bank), tout 
PORNATC ' $ ' , Sx , 'We  are  switching  fro*  bank  ',A,'  to 
bank  ' ,A, '  at  ti»e  ',P4.2,'.') 

PRINT*,'  ' 

PRINT*,'  ' 

c  /////////////////////////////////////////////////////////////////// 
c 

c  -  Experieental 

c 

C  ////////////////////////////////////////////////////////////////// 

IP(Bank.gt.l)then 


9700 

♦ 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


Do  i  •  1,  Nuabanks 
Banknsae(i)  >  Banknaaa(l) 
Enddo 


wuuuuu  woow 


ELSE 


Do  i  >  1,  Nuabanks 
Banknaaad)  •  Of  ila  ( (  i«’3 ) ,  1 ) 
Enddo 

ENDir 


-4--Sat  th«  probability  valua  of  tha  naw  filtar  aqual  to  tha 
probability  of  tha  filtar  in  tha  previous  bank.  Also  sat 
tha  other  filtar  probabilities  equally  so  tha  overall 
probability  equals  one. 


DO  1781  ti«4.NPLTR(bank) 
ir  (ti.aq.iq)  THEN 

prbnaw( ti , ir )-prbnaw( iq, bankold) 

ELSE 

prbnaw( tl . i r )>( 1 . 0-prbnaw( Iq, bankold ) )/ 
S  ( float(NPLTR(bank)-4) ) 

ENDIP 

1781  CONTINUE 

tswi tch«tout/( tsaap) 


--S--This  test  tails  us  if  wa  have  tasted  all  banks  but  cannot 
locate  an  appropriate  bank. 


ELSE  IP  ( ( ir .aq.nuabanks)  .and.  (count. aq. 0) )  THEN 
WRITE(*.9701) 

9701  PORHAT( <Sx, 'Na  have  passed  tha  switch  test, 

♦  but  have  no  other  bank  to  switch  to,  ') 

HEITE(*,9703)  Bank 

9703  POEHAT( , Sx, 'so  wa  are  staying  in  bank  nuabar' ,12, ' . ' ) 

HRITB(*,9702)  Dfila(4,Bank) 

9702  PORKATl *$' ,5x, ' (Tha  naaa  of  this  bank  is  *,A,'.)') 
PRINT*,'  ' 

count'count-*! 

END  IP 

1774  CONTINUE 

1773  CONTINUE 


C . 

IP( ( TOUT. GE.0.0) .AND. (TOUT. LE. 8.0) ) THEN 
HRITE(51,*)'  PRBNEH  at  tiaa:  ',TOUT 
HRITE(S2,*)'  PRBNEW  at  tiaa:  ',TOUT 
DO  IZXQ  -  4,18,4 

HRITE( 51 ,* )PRBNEH( IZXQ, i ) ,PRBNEH( IZXQ«1, 1 ) , PRBNEN( I ZXQ* 2 , 1 ) , 

S  PRBNEW(  IZXQ*-!,  1  ) 

writa( 52, • )PRBNEW( IZXQ. 2 ), PRBNEH ( IZXQ*-!, 2 ) , PRBNEH ( 1ZXQ*2 , 2 ) , 
t  PRBNEH(  IZXQ'»3,2) 

ENDDO 

ENDIP 

C/ ///////////////////////////////// ///////////////////////////////////// 
C/////////////////////////////////////////////////////////////////////// 

300  CONTINUE 

C/////////////////////////  END  TIHE  RESPONSE  LOOP  ////////////////////// 
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z///////////////////////////////////////// ////////////////// //////////// 


ir  ( 11k.n«.xit«r)  THEN 
pullf 
Count>Q 

Banktl 

Bankold«Bank 
Bankf 
END  ir 

780  CONTINUE 

C$$$$$$$$$$$$$$$$$$$$$$$$$$  END  HONTE  CARLO  LOOP  $$$$$$$$$$$$$$$$$$$$$$$ 

C$$$$$$$$8$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$ 

C$$$$$S$$$$$$$$$$S$$$$$$$$$$$$$$$$$$$$$$$$S$$$$$$$$$$$$$$$$$$$$$$$$$$$$$ 

C********************************************************************* 

C  -  Now  noraalita  everything  by  the  number  of  Monte  Carlo  iterations. 

C  And  set-up  array  for  slnola  scalar  residuals  to  be  read  in 

C  HATSAV.  The  array  RSID  is  sat  up  such  that  the  rows  correspond 
C  to  the  time  increment  number.  The  columns  are  as  follows: 

C  columns  1:7  correspond  to  the  scalar  residuals  of  filter  14, 

C  columns  8:14  correspond  to  the  scalar  residuals  of  filter  85, 

C  etc.,  until  the  last  filter. 

. . . 


DO  75S  JZ-1.10 

DO  754  I2-l,ISTOP 

IP  (JZ.le.8)  STATES(1Z,JZ)-STATES(IZ,JZ)/XITER 

IP  (JZ.le.8)  THEN 

INPUTS! IZ, JZ)-INPUTS(IZ, JZ)/XITBR 
DEPLEC! IZ, JZ)«DEPLEC(1Z,JZ)/XITBR 
END  IP 

PROBS( IZ,JZ)-PROBS(IZ,JZ)/XITER 

IP  (JZ.le.7)  PROBS( IZ, JZ'flO)>PROBS( IZ,JZ«10)/XITER 

OUT! IZ, JZ)-OUT(IZ,aZ)/XITER 

OUT! IZ, JZ*10)-OUT1IZ, JZ+10)/XITER 

IP  !JZ.LE.9)  OUT1IZ,JZ^20)-OUT|IZ,JZ+20)/XITER 

IP  !JZ.LE.2)  ACCBL!IZ,JZ)-ACCBL!IZ,JZ)/XITER 

IP  ! JZ.LE.7)THEN 

IP  !  ! IZ.GE.SMPON) .AND. ! I Z . LT . SMPOPP ) )THEN 
DO  II-4,NrLTR!l) 

IIMOD-II-3 

RSID!  IZ-SNPON'fl,INT!  !II-4)*74-JZ)  )-rSSave!  IZ,JZ,IIHOD) 
BDUSG! IZ-SHPON4-1. INT! ! I 1-4 ) •7sJZ ) ) -bussave ! IZ , JZ , I INOD ) 

IP!BANK.NE.1)THEN 

RSIDTWO! IZ-SMPON+l, INT! ! I 1-4 ) •7+JZ ) ) - 
4  rssave! IZ,2Z. IINOD) 

BDUSGTWO! IZ-SHPON»l , INT! ! II-4 ) •7^JZ ) )- 
4  buzsave! IZ, JZ, IINOD) 

END  IP 

C  write!*, •)  ' -  mmaeslm  -  ',1* 

C  write! • , * Ibussave! IZ, 4 ,8) 

C  iixstpc-IZ-SNPON4'l 

C  Iltstpb-INT!!1I-4)*7*JZ) 

C  write! *, * )BDUSG! iisstpc,iixstpb),listtpc,iisctpb 
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lf( lizztpb.«q.91 ) thtn 
wclt«( *>  *) ilzztpc,BDUSG( llzztpc,91) 
•  ndie 

END  00 
END  IP 
END  IP 

754  CONTINUE 

755  CONTINUE 


---  Mean  and  Standard  Deviation  of  Probabilities  Coapuation 

Note,  the  data  used  froa  this  section  should  be  used  with  care 
if  hierarchical  (2  failures)  aodelina  is  used,  Por  no  failures 
it  is  assuaed  that  the  aean  and  standard  deviation  can  be 
avera9ed  over  the  entire  len9th  of  the  slaulation.  Por  sln9le 
failures  (w/o  hierarchical  aodelln9),  it  is  assuaed  that  the 
aean  and  standard  deviation  are  averaaed  over  two  tiae  periods: 
(1)  froa  tiae  zero  to  tiaelaol,  and  (2)  froa  tiaala9l  to  the 
end  of  the  slaulation.  Por  double  failures  (hierarchical 
aodelin9).  It  Is  assuaed  that  the  aean  and  standard  deviation 
are  avera9e  over  three  tiae  periods:  (1)  froa  tiae  zero  to 
tlaala9l,  (2)  froa  tiaela9l  to  tiaela92,  and  (3)  froa  tlaela92 
to  the  end  of  the  slaulation.  NOTE:  Por  hierarchical  aodelin9 
we  are  assualn9  the  banics  are  switched  at  tlaela9l.  However, 
there  should  be  a  sli9ht  la9  froa  tlaelaol  to  bank  swltchin9. 
Therefore,  caution  should  be  used  when  hierarchical  aodelin9 
is  lapleaented. 


DO  kk-1,3 

DO  kJ-l,NPLTH(i) 
aeanprob(kk,kj )«0.0 
stddev(k1:,kj)>0.0 
END  DO 
END  DO 


- PI  ret  coapute  the  aean. 


DO  kJ-4,NPLTH(l) 

IP(nuafalls.eq.O)THEN 
Teapl>0 . 0 
DO  ki-l,IST0P 

Teapl-Teapl»Probs(ki,kj) 

END  DO 

Meanprob(l,kJ)-Teapl/Ploat( ISTOP) 

ELSE  lP(nuBfalls.eq.l)THEN 
Teapl«0 . 0 

DO  kl«l.IPlX(tiaela9l/tsaBp)-l 
Teapl-Teapl>Probs(ki , k j  ) 

END  DO 

Meanprob( 1 ,k j )»Teapl/( ( tiaelaql/tsaap)-!  .  ) 
Teapl-0 . 0 

DO  kl-IPIXCtlaelaql/tsaap), ISTOP 
Teapl-Teapl+ProbsC  ki  ,  k J ) 

END  DO 

Meanprob( 2 , k}  )* 

4  Teapl/i Ploat( ISTOP)-( tiaelaql/tsaBp)^! . ) 

ELSE  lP(nuBfalls.eq.2)THEN 
Teapl'0.0 
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00  ki-1 , iriX( tiB«l<9l/ttaap)-l 
Taapl-Teapi^probal ki <  kj ) 

END  00 

M«anprob( 1 ,k j )-T»apl/( (tlaela9l/ttaBp)-l.  ) 

Ttapl>0 . 0 

DO  kl>iriX( tiaela9l/tiaap) ,  IPIX(  tiaela92/ttaBp)-l 
T«Bpl-Teapl'fproba(ki,kj ) 

END  DO 

Haanprob(2,kj)« 

4  Ta«pl/( (tlaela92-tiaala9l )/taaBp) 

Taapl>0 . 0 

DO  ki-lPIX(tiBala92/tiaBp).ISTOP 
TaBplaT«apl'*'probt(kl ,  k  j  ) 

END  DO 

Naanprob( 3,kj)- 

4  Taapl/(Ploat(ISTOP)-(tiaala92/tBaBp)-fl.  ) 


ENj  ip 
END  DO 


Now  coaputa  tha  standard  deviation. 


DO  k j-4 ,NPLTR( 1 ) 

IP(nuafailt.aq.O)THEN 
TaBp2-0 . 0 
DO  ki-l,ISTOP 

TeBp2-Taap2*( (probs( ki , k J )-Meanprob(l,kj)  )»*2) 

END  DO 

Stddev( l,k j )-sqrt(TeBp2/Ploat( ISTOP) ) 

ELSE  IP(nuBfailt.aq.l)THEN 
Taap2>0.0 

DO  ki-l,IPlX(tlaala9l/t$a*p)-l 

Taap2>Taap2'f  ( (probt(ki,kj)  -Heanprob(  1 ,  k  j  )  )  •  *2  ) 

END  DO 

Stddav( 1 , k j )»sqrt(TeBp2/(  ( t  iaalaql/tsaap )-!.)) 
TaBp2-0 . 0 

DO  ki-IPlX(t<<«ela9l/tsaap) ,  ISTOP 

TaBp2«Ta£..  '-•’((probsCki.kj)  -HeanprobC  2  ,  k  j  ) )  •  *2  ) 

END  DO 

Stddav(2,kJ> 

4  sqrti TeBp2/( PloatC ISTOP )-( tiaalaql/tsaap )♦!.)) 

ELSE  IP(nuafails.aq.2)THEN 
Taap2-0 . 0 

DO  ki>l , IPIX( tiaalaql/tsaap)-! 

Teap2-Taap2'f(  ( probB(  k  i  ,  k  j  )  -Heanprob(  1 ,  kj  )  )**2) 

END  DO 

Stddav( 1 ,k j )>sqrt(Taap2/( ( tiaelaql/tsaap)-! .  )  ) 
Teap2-0 . 0 

DO  ki-lPlX( t iaalaql/tsaap ) ,  I PIX(  t iBela92/t saap ) -1 
Taap2-TeBp2i'  ( (probs(ki,kj)-Naanprob(2,kj ) )»*2) 

END  DO 

Stddav ( 2  ,  k j  )• 

4  sqrt(Teap2/( (tiBela92-tiaela9l)/tBaBp)) 

TaBp2>0 . 0 

DO  kl-IPIX( tiBela92/tsaBp) , ISTOP 

Teap2-Taap2'»  ((pcobs(ki,kj)  -Haanprcb(  3 ,  k  j  )  )  *  *2  ) 

END  DO 

StddavC  3,k j  )- 

4  sqrti TaBp2/( ploat( ISTOP)-(  t iaala92/tsaap)  +  l . ) ) 


END  IP 
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c 

c 


END  DO 


-  Call  HATSAV  to  9«n«rate  NATRIXX  data  fllat  for  plotting 


CALL  MATSAV( 71, 'Tl'. 513,1  STOP , 1,0, TVEC , DUMHYJ , 

4'(10A8)' ) 

CALL  KATSAV( 71 , ' IN' , 51 3 , ISTOP , 6 , 0 , INPUTS , DUHMYJ , 

4 ' ( 10A8 ) ' ) 

CALL  RATSAV( 71 , 'ST' , 51 3 , I  STOP , 8 , 0 , STATES , DUKNYJ , 
4'(10A8)') 

CALL  HATSAV(7l, 'DP' , 51 3 , 1  STOP , 6 , 0 , DEPLEC , DUHMYJ , 
4'(10A8)'  ) 

CALL  MATSAV(71 , 'PRB' , 51 3 , 1  STOP, 1 7 , 0 , PROBS , DUMMYJ , 

4' (10A8) '  ) 

CALL  KATSAV(71, 'GS' , 51 3 , 1  STOP, 2 , 0 , ACCEL , DUMMYJ  , 

4' ( 10A8) ' ) 

CALL  MATSAV( 71, 'TS' , 192 , SMPOPP-SMPON , 1 , 0 , TSHORT, DUMMYJ , 
4'(10A8)' ) 

CALL  MATSAV (71,'RS',192, SMPOPP-SMPON , 9 1 , 0 , RS 1 D , DUMMYJ , 

4' ( 10A8) ' ) 

CALL  MATSAV( 71 , ' BDU' , 192 , SMPOPP-SMPON, 91 , 0 , BDUSG, DUMMYJ , 
4' ( 10A8)  '  ) 

CALL  MATSAV( 71, 'MN' , 3 , 3 , 16 , 0 , MEANPROB , DUMMYJ  , 

4' ( 10A8) ' ) 

CALL  MATSAV( 71, 'SIG' , 3 , 3 , 16 , 0 , STDDEV , DUMMYJ , 

4' ( 10A8)  '  ) 


C  2  nd  MATRiXx  Plotting  fila  for  second  bank 

C  . . ««*♦*»*»*..**.**«•»«**.*.**».*.*.**** 


CALL  MATSAV( 72, 'TI' ,51 3, ISTOP, 1,0, TVEC, DUMMYJ, 

4 ' ( 10A8  )  '  ) 

CALL  MATSAV(72, 'PRB' , 51 3 , ISTOP , 17 , 0 , PRBBNK2 , DUMMYJ , 

4' ( 10A8) ' ) 

CALL  MATSAV( 72 , ' TS ' , 192 , SMPOPP-SMPON ,1,0, TSHORT, DUMMYJ , 

4' ( 10A8) ' ) 

CALL  MATSAV ( 72, ' RS ' , 192 , SMPOPP-SMPON , 91 , 0 , RS I DTWO, DUMMYJ , 

4' ( 10A8) ' ) 

CALL  MATSAV(72, 'BDU' , 192 , SMPOPP-SMPON , 91 , 0 , BDUSGTWO, DUMMYJ , 

4 ' ( 10A8  )  '  ) 

9999  CONTINUE 

Q// //////////////////////////////////////// ///////////////////////// 

C  END  OP  MMAESIN 

C- - - - ............. 

C.................... - .......................... - ........... 

END 
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SUBROUTINE  AOPCON(  PRBTHP .  PRBOI.O,  ZXHP  ) 
INCLUDE  'DECLARR.TXT' 


local  variablaa 


INTEGER  I.J,R,PORDER(20.1S) 

REAL  PRBTMP(20,1S),PRBOLD(20,15),ZXHP(8,20) 

REAL  PRBSUN,POUHHy(20,lS)  ,TEHP.PRBDLT,PRBDUH(20,1S) 
REAL*16  PRBHRK.QDELT 


-  Calculata  tha  noraalixln^  factor  for  tha  probabllitlea, 

tha  danoainator  of  aquation  10-104  of  Hayback. 


PRBSUH-0. 

QDELT-0. 

DO  10  I-l,NPLTR(Bank) 

IP  ( ( I  .na .aodalnl )  .and.  ( I  ..'^a .aodaln2 ) 

*  .and.  ( I .ne .aodalnJ ) )  THEN 

PRBSUH-PRBSUH+PRBTNPd  .Bank  ) 

END  If 
10  CONTINUE 


---  Calculata  tha  pcobabilltias,  atorad  in  PRBHRK. 

---  If  a  probability  ia  lesa  than  tha  alniaua  acceptabla 
probability.  PRBHIN,  aat  it  equal  to  PRBHIN. 

Havinq  to  reset  any  probabllitiaa  to  PRBHIN  will  causa  tha  sua 
of  tha  probabilities  to  exceed  one.  To  fix  this,  the  following 
alqoritha  keeps  track  of  tha  errors,  which  is  tha  sua  of  all  the 
(PRBHIN  -  PRBHRK).  This  error  is  than  subtracted  froa  tha  highest 
probability,  as  found  froa  a  call  to  DSORT.  This  results  in  tha 
sua  of  tha  probabilities  equal  to  one. 

QEXT  is  an  intrinsic  function  that  returns  . 

SNGLQ  is  a  . 


DO  20  J«l.NrLTR(Bank) 

IP  ( ( J . ne . aodelnl )  .and.  ( J.ne.aodeln2) 

*  .and.  ( J.na.aodeln3) )  THEN 

PRBWRK-OEXT  (  PRBTHP  (  J .  Bank  )  )  /QEXT  (  PRBSUH ) 

IP  (PRBHRK. LT. QEXTIPRBHIN) )  THEN 
QDELT-QOELT-»  ( QEXT(  PRBHIN  )  -PRBHRK ) 
PRBHRK-QEXT( PRBHIN) 

END  IP 

PRBNEH( J . Bank ) •SNGLQ( PRBHRK ) 

PRBOLD( J . Bank ) >PRBNEH( J . Bank ) 

END  IP 
20  CONTINUE 

PRBDLT>SNGLO(QDELT) 
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C  Now,  create  a  vector  with  the  Indices  of  the  sorted  probabilities 

C  (hl9h  to  low.)  Note:  PRBNEH's  orderln9  Is  not  chan9ed. 

. . . 


DO  I«1,NPLTR(BANK) 

PRBOUM(  I  ,  BANK  )  -PRBNEW(  I ,  BANK  ) 
ENDDO 

CALL  DSORT(PRBDUM,NPLTR,PORDER) 


C***************************************************************** 

C  -  Decrease  the  hl9hest  probability  by  PRBDLT  to  ensure  overall 

C  probability  Is  1.0 

C» *»»•****••*»*****»»»»*•*»•*********•*»»»**•***»»*******»**»»»*»» 


PRBNEW( PORDER( 4,Bank)  ,Bank)-PRBNEW{  PORDER( 4,Bank ) , Bank ) -PRBDLT 
PRBDUH( POROER( 4,Bank)  ,Bank)-PRBDUH(  PORDER(  4 .Bank ) .Bank) -PRBDLT 

C********************************************************************* 

C  Below  are  various  Methods  to  use  the  probabilities  to  calculate 

C  the  wel9hted  sum  state  estiaate,  XHPSUH.  Selection  Is  based  on 

C  what  the  fla9  ISCLT  Is  set  to. 

C***«***************************************************************** 

Cl 11111111111111111111111111111111111111111111111111111111111111111111 

C  -  Method  1.  Use  only  the  filter  estimate  and  raw  probability 

C  of  the  highest  probability  filter. 

IP  (ISLCT.EQ.l)  THEN 

CALL  ACALC(ZXHP,PRBDUN,P0R0ER,4) 

C222222222222222222222222222222222222222222222222222222222222222222222 
C  ---  Method  2.  Use  only  the  filter  estiaate  of  the  highest  probability 
C  filter  and  then  set  that  probability  equal  to  one. 

ELSE  IP  ( ISLCT.EQ.2)  THEN 

PDUMMY ( PORDER ( 4 , Bank ) , Bank  )  -1 . 

CALL  ACALCiZXHP.PDUMNy, PORDER, 4) 

C3 33333333333333333333333333333333333333333333333333333333333333333333 

C  -  Method  3.  Use  all  the  filter  estlaates  and  their  associated  raw 

C  probabilities. 

ELSE  IP  (ISLCT.B0.3)  THEN 

CALL  ACALC  (  ZXHP ,  PRBDUM,  PORDER ,  NPLTR  ) 

C4 44444444444444444444444444444444444444444444444444444444444444444444 

C  —  Method  4.  Use  the  two  highest  filter  probabilities  with  their 

C  raw  probabilities. 

ELSE  IP  (ISLCT.EQ.4)  THEN 

CALL  ACALC(ZXHP, PRBDUM, PORDER, 5) 

C5555555555555555555555555555555555555555555555555555555555555555S5555 

C  -  Method  S.  Use  the  two  highest  filter  probabilities  and  readjust 

C  their  probabilities  so  that  the  two  equal  one. 

ELSE  IP  (ISLCT.EQ.S)  THEN 

TEHP-PRBNEW( PORDERC  4 . Bank ) .Bank ) ♦PRBNEWC  PORDER( S , Bank ) .Bank) 
PDUNMY( PORDER (4. Bank)  .Bank) -PRBNEH(  PORDER( 4 , Bank ) ,Bank)/TEHP 
PDUNNY( PORDER ( 5. Bank) .Bank )>PRBNEW(  PORDER ( 5, Bank ) .Bank )/TEHP 
CALL  ACALC(  ZXHP,  PDUMMY.  PORDER,  S) 

C?7??77?7777?777?77777777?777?777777?77777?7777777 77777777777777777 777 
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-  If  ISLCT  Is  anythin9  besides  1  to  S,  then  the  default  will  be 

Method  3. 

ELSE 

CALL  ACALC ( ZXHP , PRBDUM , PORDER , NPLTR ) 

END  IP 
RETURN 


END  AOPCON 


END 
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SUBROUTINE  PULLOUT 


-  Pull  out  arrays  from  conmon  block  rawdat  which  raaaln  constant 

aiton9  the  controllera. 

Recall  NTXC32  Is  a  3-d  vector  to  2-d  vector  conversion  routine. 


INCLUDE  'DECLARR.TXT' 


local  variables 


Pull  out  the  A,  B,  R,  H,  and  CQDCNT  aatrices  froa 
the  raw  data. 


WRITE(*,»)  'START  PULLOUT' 

CALL  MTXC32(ZA,A,8,«,20,HODELN,1,0) 

CALL  MTXC32(ZB,B.S,6,20.HODELN,1,0) 

CALL  MTXC32(ZC,C,29,29,:0,MODELN,1,0) 

CALL  NTXC32(ZR.R,7,7,20,HODELN,1,0) 
WRITE(*.*) 'A' ,A 

CALL  NTXC32(ZH,H,7,1«,20,NODELN,1,0> 

CALL  MTXC 3 2 ( ZCQDCN , CQDCNT ,0,8,20, NODELN ,1,0) 


-  Create  a  7  X  29  HT  fro*  the  7  x  14  H  matrix  which  is  in  the  chosen 
truth  model  file.  This  is  done  to  retain  matrix  site  inte9rity. 
Where , 

HT  - 


H(l,l)  , 

8(2,1), 


,H(1,8),H(1,9),0,0,0,H(1,10),0,0,0,H(1,11),0,0,0, 

,H(2,8),H(2,9),0,0,0,H(2,10),0,0,0,H(2.11),0,0,0, 


,H(1,14) 

,H(2,14) 


H(7,l) 


.,H(7,'8),H<7!9),6,0,0,H(7!iO),6,6,6,H(7|i1),6,6,0. 


,H(7!i4) 


DO  1031  IA>1,29 

DO  1030  IB-1,7 

IP  (IA.LE.0)  THEN 
HT(  IB,IA)-H(IB, lA) 

ELSEir  (  (  IA.EQ.9) .OR.( IA.EQ.13) .OR. ( IA.EQ.17) .OR. 
t  (  IA.EQ.21) .OR. ( IA.EQ.25) .OR. ( 1A.EQ.29) )  THEN 

HT(  IB,  IA)-H(  IB,  INT(  9'»(  IA-9)/4  )  ) 

ELSE 

HT(IB,IA)-0. 

END  IP 

1030  CONTINUE 

1031  CONTINUE 

C  HRITE(*,*) 'END  PULLOUT' 

RETURN 

C  END  PULLOUT 
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SUBROUTINE  EOH(T,X,DX) 


. . . . 

C  REVISION  BLOCK  12  JULY  -  Dcomaon  block  CONTROLS!  aodlfltd 
C  to  Include  array  AUNEW  -  2)  subroutine  name  chan9e  to 
C  ISTACT  -  AlSTACTj  2NDACT  -  A2NDACT;  4THACT  -  A4THACT  -  3) 

C  variables  passed  within  AlSTACT, A2NDACT, A4THACT  had  names 
C  modified  to  prevent  an  access  error  when  chan9in9  a  value 
C  within  a  passin9  strln9  that  is  a  constant  In  the  main 
C  routine  (ex:  CALL  A1STACT( 2 , 1 , 60 . 0 , -60 . 0 , 2 . 0 )  in  main 
C  routine  -  SUBROUTINE  A1STACT( IX, I Y, UPRTLIH, LWRTLIH, XBIAS ) 

C  one  cannot  chan9e  the  value  of  any  of  these  variables 
C  within  the  strin9  since  the  variable  value  will  not  match 
C  hardwired  value  in  the  orl9inal  code.  Yet  we  need  to 
C  convert  these  values  from  de9  and  de9/sec  to  rad  and 
C  rad/sec  in  the  subroutine.)  Fixed  by  chan9in9  names  within 
C  the  subroutine  ar9ument  list;  UPRTLIN  ->  AUPRTLIH  etc 
C 
C 
C 

C* »*»»»»»>»*••**•*•»*»»•» »»**»*•***»•»*»»»»•*»»*•»***»*»»**»** 

c 

C  SUBROUTINE  EON  calculates  the  Incremental  dynamics  of  the 
C  air  vehicle  by  passin9  a  set  of  ordinary  differential 
C  equations  to  SUBROUTINE  DEABH,  a  differential  equation 
C  solvinq  routine.  A  29  x  29  |A)  matrix  contains  the  data 
C  descrlbinq  the  coefficients  of  the  differential  equations 
C  to  be  solved  simultaneously  by  DEABH.  SUBROUTINE  EOM 
C  calculates  the  effects  from  control  surface  deflections 
C  and  includes  those  incremental  affects  into  the  incremental 
C  dynamic  effects  for  a  sinqle  sample  period.  The  routine 
C  Includes  actuator  dynamics  and  position  and  rate  limltinq. 

C  The  true  fourth  order  actuator  dynamics  models  are 
C  represented  as  first  order  within  the  system. 

C 

C  Creation  Date:  26  June  1991 
C  Revision  Date:  27  Nov  1991 
C  Owner:  USAP/ASD/APIT/EN 
C 

C*****************************************************.******* 


INCLUDE  'DECLARR.TXT' 


local  variables 


INTEGER  I,J 

REAL  BNL(8,6).X(29).DX(29),T 

REAL  TPAl ,TPA2 ,TPB2,TPC2,TPA4 ,TPB4,TPC4 ,TPD4 ,TPE4 .XBIAS 

COMMON/ACTVALl/TPAl 

COMMON/ACTVAL2/TPA2 , TPB2 , TPC2 

COMMON/ACTVAL4/TPA4 , TPB4 , TPC4 , TPD4 , TPE4 


DATA  WPLAG, IACTORDR/0, 1/ 

DATA  TPAl/20.2/ 

DATA  TPA2,TPB2,TPC2/1. 0,1. 0,1.0/ 

DATA  TPA4,TPB4,TPC4,TPD4,TPE4/l.492537E+07,268.67,2.5373lE'f04, 
41.1492537E^06,1.492537E*07/ 


HAIN  PROCESSING  ALGORITHM 
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n  n  n  n  n  n  n  n  n  n  n  n  nnn  n  nnoo  nnnn  n  nnn  nnnnnnnnnnnn no  n 


D  E  r 

1  N  I  T  I  0  N 

0  P 

THE 

STATE 

V  A  R  I  A  1 

X(l)  - 

THETA 

X(9) 

-  LEPT 

STABILATOR 

POSITION 

X(2)  - 

VELOCITY 

x(iO) 

-  LEPT 

STABILATOR 

RATE 

X(3)  - 

ALFA 

X(ll) 

-  LEPT 

STABILATOR 

3RD  STATE 

X(4)  - 

PITCHRATE 

X(12) 

-  LEPT 

STABILATOR 

4TH  STATE 

X(5)  - 

ROLL  ANGLE 

X(6)  - 

BETA 

X(13) 

-  BIGHT 

STABILATOR 

POSITION 

X(7)  - 

ROLL  RATE 

X(14) 

-  RIGHT 

STABILATOR 

RATE 

x(e)  - 

PITCH  RATE 

X(15> 

-  RIGHT 

STABILATOR 

3R0  STATE 

X(16) 

-  RIGHT 

STABILATOR 

4TH  STATE 

X(17) 

-  LEPT  PLAPERON 

POSITION 

x(ie) 

-  LEPT  PLAPERON 

RATE 

x«  19) 

-  LEPT  STABILATOR  3RD 

STATE 

X(20) 

-  LEPT  STABILATOR  4TH 

STATE 

X(21) 

-  RIGHT  PLAPERON  POSITION 

X(22) 

-  RIGHT  PLAPERON  RATE 

X(23) 

-  RIGHT  PLAPERON  3RO 

STATE 

X(24) 

-  RIGHT  PLAPERON  4TH 

STATE 

X(25) 

-  RUDDER  POSITION 

X(26) 

-  RUDDER  RATE 

X(27) 

-  RUDDER  3RD  STATE 

X(28) 

-  RUDDER  4TH  STATE 

X(29) 

-  LEADING  EDGE 

PLAP  POSITION 

END  or  STATE  DEflNlTIONS 


INITIALIZE  [B]  HATBIX 


DO  I  -  l.B 
DO  J  -  1,6 

BNLd.J)  -  B(I.J) 

ENDDO 

ENDDO 

WBITE( •, • ) 'EON  SUBROUTINE  ' 

WRITE(»,»)'B  MATRIX  -  ',B 

DO  1-1,4 

WR1TE{»,»)('A{ '/J,' )  ',A(I,J),J-1,4) 
ENDDO 

DO  1-1,8 

WRITE( •,•) ( 'BNL' ,1, '  ,  '  ,  J,  '  )  ’ ,BNL(1,J) , J-1,6) 
ENDDO 


C  -  Allov  29  -  Btat*  truth  aodal  to  incorporatt  actuator  dynaalci 
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C  or  the  Oryden  wind  aodcl  (future  expansion)  or  both. 

C  -  AlRCRAfT  PERTURBATION  STATES 

DX(l)  -  A(1,1)»X{1)  ♦  A(1,2)*X(2)  ♦  A(1,3)*X(3)  ♦  A(1,4)»X(4) 

DX(2)  -  A(2.1)»X(1)  ♦  A(2,2)*X(2)  ♦  A(2,3)»X(3)  ♦  A(2,4)»X(4) 

DX(3)  -  A{3.1)‘X(1)  ♦  A(3,2)*X(2)  ♦  A(3.3)*X{3)  ♦  A(3,4)»X(4) 

DX(4)  -  A(4.1)»X(1)  ♦  A(4.2)*X(2)  ♦  A(4,3)*X(3)  ♦  A(4,4)*X(4) 

DX(5)  -  A(5,5)»X{5)  ♦  A(5,6)*X(6)  ♦  A(5,7)*X(7)  ♦  A(5,8)*X{8) 

DX(6)  -  A(6,5)*X(5)  ♦  A(6,6)»X{6)  ♦  A(6,7)»X(7)  *  A(6,8)»X(8) 

DX(7)  -  A(7.5)‘X(5)  4.  A(7.6)»X(6)  ♦  A(7,7)*X{7)  ♦  A(7,8)‘X(8) 

DX(8)  -  A(8,S)4X(S)  4  A(8,6)*X(6)  4  A(8,7)4X(7)  4  A(8,e)*X(8) 

C  -  ACTUATOR  STATES  (initialised  to  sero) 

c  -  DirrERENTIAL  LEFT  STABILATOR  -  ( 4TH  ORDER  ACTUATOR) 

0X(9)  -  0. 

DX(IO)  -  0. 

DX(ll)  -  0. 

DX(12)  -  0. 

C  -  DirrERENTIAL  BIGHT  STABILATOR  -  ( 4TH  ORDER  ACTUATOR) 

OX(13)  •  0. 

DX(14)  •  0. 

DX(IS)  -  0. 

OX(16)  -  0. 

C  -  LEFT  FLAPERON  (4TH  ORDER  ACTUATOR) 

DX(17)  -  0. 

DX(18)  -  0. 

0X(19)  -  0. 

DX(20)  >  0. 

C  . -  RIGHT  FLAPERON  -  ( 4TH  ORDER  ACTUATOR) 

OX(21)  «  0. 

DX(22)  •  0. 

DX(23)  -  0. 

DX(24)  «  0. 

C  -  RUDDER  -  (4TH  ORDER  ACTUATOR) 

DX(2S)  •  0. 

DX(26)  «  0. 

DX(27)  -  0. 

DX(28)  -  0. 

C -  LEADING  EDGE  FLAP -  (1ST  ORDER  ACTUATOR) 

DX(29)  •  0. 


C  INCREMENTS  TO  THE  EQUATIONS  OF  MOTION  DUE  TO  ACTUATOR  EFFECTS 

DX(2)  -  DX(2)  4  BNL(2.1)*X(9)  4  BNL( 2 , 2 ) *X( 13 )  4  BNL( 2 , 3 ) *X( 17 ) 
*4  BNL(2,4)*X(21)  4  BNL(2,6)»X(29) 

DX(3)  •  DX(3)  4  BNL(3,1)*X(9)  4  BNL ( 3 , 2 ) ‘X ( 1 3 )  4  BNL( 3 , 3 ) •X(  17 ) 
44  BNL(3,4)*X(21)  4  BNL(3,6)»X(29) 

DX(4)  •  OX(4)  4  BNL(4,1)*X(9)  4  BNL( 4 , 2 ) •X( 1 3 )  4  BNL( 4 , 3 ) *X( 17  ) 
44  BNL(4,4)4X(31)  4  BNL(4,6)*X(29) 

DX(6)  -  DX(6)  4  BNL(6.1)*X(9)  4  BNL( 6 , 2 ) •X( 1 3  )  4  BNL( 6 , 3 ) *X( 1 7  ) 
44  BNL(6,4)*X(21)  4  BNL(6,S)*X(2S) 

OX(7)  -  DX<7)  4  BNL(7,l)4X/9)  4  BNL( 7,2) ‘Xf 1 3)  4  BNL( 7 , 3 ) •X( 17 ) 
44  BNL(7,4)*X(21)  4  BNL(7,5)4X(2S) 
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OX(S)  -  DX(e)  ♦  BNL(8.1)*X(9)  ♦  BNL(8,2)*X(13)  ♦  BNL(8,3)*X(17) 
t*  BNL(8.4)*X(21)  «  BNL(8,S)*X(2S) 


C  INCREMENTS  TO  THE  EQUATIONS  OE  MOTION  DUE  TO  ACTUATOR  EFFECTS 

DX(2)  -  DX(2)  ♦  BNL(2,1)*AUNEW(1)  ♦  BNL( 2 , 2 ) *AUNEW( 2 ) 
t  *  BNL(2,3)*AUNEW(3)  *■  BNL(2,4)*AUNEW(4)  *  BNL( 2 . 6 ) *AUNEW( 6 ) 

DX(3)  •  DX(3)  *  BNL(3,1)*AUNEW(1)  *  BNL( 3 , 2 ) *AUNEW( 2 ) 

4  ♦  BNt.(3,3)*AUNEW(3)  ♦  BNL(  3, 4  )  *AUNEW(  4  )  *  BNL(  3 , 8  )  *AUNEW(  6  ) 

DX(4)  -  DX(4)  4  BNL( 4,1)*AUNEW( 1 )  *  BNL( 4 , 2 ) *AUNEW( 2 ) 

4  *  BN1.(4,3)*AUNEW(3)  *  BNL(4,4)*AUNEW(4)  4  BNL(  4 , 6  )  *AUNEH(  6  ) 

0X(6)  -  DX(6)  4  BNL(6,1)*AUNEW(1)  4  BNL( 6 , 2 ) •AUNEH( 2 ) 

4  4  BNt.(6,3)*AUNEW(3)  4  BNL(  6 . 4  )  *AUNEW(  4  )  4  BNL(  6  ,  S  )  *AUNEW(  5  ) 

DX(7)  -  DX(7)  4  BNL(7.l)*AUNEW(l)  4  BNL( 7 , 2 ) ‘AUNEWC 2 ) 

4  4  BNI,(7,3)4AUNEW(3)  4  BNI,(7,4)»AUNEW(4)  4  BNL  (  7 , 5  )  •AUNEW(  5  ) 

0X(8)  •  0X(8)  4  BNL(8,1)4AUNEW(1)  4  BNL( 8 . 2 ) *AUNEW( 2 ) 

4  4  BN1.(8,3)*AUNEW(3)  4  BNL(8.4)*AUNEH(4)  4  BNL(  8  ,  S  )  *AUNEM(  S  ) 


ACTUATOR  EFFECTS 


coaplctt  actuAtor  raponscs 


NOTE: 

AISTACT,  A2NDACT,  A4THACT  provid#  coaplatt  actuator  packa9e8 
lncludin9  rata  lialtin9,  tha  approprlata  la9a,  and  filtara, 
and  poaitlon  llaltin9. 


-  Dlffarantlal  Stabllatora  - 

-  LEFT  STABILATOR  -  DX(9)  -  DX(I2) 

Tha  fla9  IXVALZ  controls  which  alaaants  within  tha  OX  and 
X  array  ara  utilisad  for  aach  control  surfaca 

I F ( I ACTOROR . EQ . 1 ) CALL  Al STACT (X,DX, 9, 1,60.0,-60.0, 
421.0,-21.0,2.0) 

1F( IACTORDR.EQ.2 )CALL  a2NDACT( X , DX, 9 , 1 , 60 . 0 , -60 . 0 , 
421.0,-21.0,2.0) 

1 F ( I ACTORDR . EQ . 4 ) CALL  A4THACT( X,DX, 9, 1,60.0, -60.0, 
421.0,-21.0,2.0) 

C  -  RIGHT  STABILATOR  -  DX<13)  -  OX(16) 

I F ( I ACTORDR . EQ . 1 ) CALL  AlSTACT (X,DX,13,2,60.0,-60.0, 
421.0,-21.0,2.0) 

I F ( lACTORDR . EQ . 2 ) CALL  A2NDACT( X ,DX, 13, 2, 60.0, -60.0, 
421.0,-21.0,2.0) 

1 F( lACTORDR . EQ . 4 )CALL  A4THACT( X, DX, 1 3,2,60.0,-60.0, 
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(21.0,-21.0,2.0) 


-  L«adin9  Ed9«  Flap  - DX(29) 

CALL  A1STACT(X, OX, 29. 6, 30. 0,-30. 0,25. 0,-2. 0,0.0) 


C  -  Dlffacantlal  Flaparona  - 

C  - LEFT  FLAPERON -  DX(17)  -  DX(20) 


1F{ lACTORDF.EQ. 1 )CALL  A1STACT( X , DX, 17 , 3 , 61 . 0 , -61 . 0 , 
(20.0,-23.0,1.5) 

IF( lACTORDR.EQ. 2)CALL  A2NDACT( X, OX , 17 , 3 , 61 . 0 , -61 . 0 , 
(20.0,-23.0,1.5) 

1 F ( I ACTORDR . EQ . 4 ) CALL  A4THACT{ X,DX,17,3,61.0,-61.0, 
(20.0,-23.0,1.5) 

C  -  RIGHT  FLAPERON  -  DX(21)  -  DX(24) 

IF( lACTORDR.EQ. I )CALL  A1STACT{ X, DX, 2 1 , 4 , 61 . 0 , -61 . 0 , 
(20.0,-23.0,1.5) 

I F ( I ACTORDR . EQ . 2 ) CALL  A2NDACT( X,DX,21,4,61.0,-61.0, 
(20.0,-23.0,1.5) 

1F( lACTORDR.EQ. 4) CALL  A4THACT( X , DX , 2 1 , 4 , 61 . 0 , -61 . 0 , 
(20.0,-23.0,1.5) 


C  . . .  Ruddtt - DX(25)  -  DX(28) 

1 F ( I ACTORDR . EQ . 1 ) CALL  Al STACT( X,DX, 25, 5, 120. 0,-120.0, 
(30.0,-30.0,0.0) 

IF( lACTORDR.EQ. 2) CALL  A2NOACT< X, OX , 25 , 5 , 1 20 . 0 , -1 20 . 0 , 
(30.0,-30.0,0.0) 

IF( lACTORDR.EQ. 4) CALL  A4THACT( X, DX , 25 , 5 , 1 20 . 0 , -1 20 . 0 , 
430.0,-30.0,0.0) 

HRITE(*,*)'  AUNEW  -  ' ,AUNEN 
WRITE(*,*)'  END  EON' 

RETURN 


END  EON 


END 


SUBROUTINE  SECTION 


PROCESS  SUBROUTINES 


SUBROUTINE  A1STACT( X, DX, IXVALZ , IXAUNEH, AUPRTLIM , 
(ALHRTLIH,AUPPOSLN,ALHPOSLN,AXBIAS) 


•  • 

*  SUBROUTINE  AlSTACT  calculataa  a  lat  ocdar  actuator  • 
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C  •  re»pons«.  Thi»  routin*  conttruct*  a  firat  ordar 
C  *  atata  apaca  aodal  uain^  tha  ONCSS  routina/  rata 
C  *  Halt  tha  ai9nal,  aubtract  a  aachanical  blaa  and 
C  *  position  liait  tha  surfaca  coaaand. 

C  • 

C  * 

C  • 

C  •  Craation  data:  27  Juna  1991 

C  *  Ravision  data:  27  Nov  1991 

C  •  Ownat:  USAF/ASD/AriT/EN 

C  • 

INCLUDE  'DCCLARR.TXT' 

REAL  TPAl .OPRTLIM, LWRTLIN.OPPOSLIN, LWPOSLIN, XBIAS 
REAL  DX(29),X(29) 

COMMON/ACTVALl/TPAl 

CALL  ONESS(X,DX,IXVALZ,IXAUNEW) 


C  CONVERSION  ROUTINE  -  convart  bias,  rata  and  position 

C  liaits  to  rad  and  rad/sac  sinca  tha  Bi9nal  is  in  rad  and 
C  rad/sac 

C 

OTOR  -  3.1415926/180.0 
XBIAS  -  AXB1AS*DT0R 
UPRTLIH  ■  AUPRTLIN*DTOR 
LWRTLIN  •  ALWBTLIH*DT0R 
UPPOSLIH  •  AUPPOSLH*DTOR 

LWPOSLIH  -  ALWPOSLN*DTOR 


C  subtract  aechanical  bias  taras 

C  X(IXVALZ)  -  X(IXVALZ)  -  XBIAS 

C  rata  and  position  liait  tha  surfaca  coaaanda 
C 

C  wtita(*,*l'  1st  ordar  act  ' 

C 

IP( (X( IXVALZ+1) .GE.UPRTLIM) .AND. (DX( IXVALZ+1 ) .GT. 0 . 0 > )THEN 
DX(  IXVALZ'fl  )>0.0 
writa(*,*)'  uppac  rata  llaitad’ 

ENDIP 

ir(  (X(  IXVALZ^l ) .LE. LWRTLIN) .AND. {DX( IXVALZ  +  l ) .LT.0.0) )THEN 
OX( IXVALZ+1 )-0.0 
WRITE(»,*)'  lower  rata  llaitad' 

ENDIP 

IP( (X( IXVALZ) .GE.UPPOSLIN) .AND. (DX( IXVALZ) .GT.0.0) )THEN 
DX(1XVALZ)-0.0 

WR1TE(*,*)'  upper  position  Halted' 

ENDIP 

IP( <X( IXVALZ) .LE.LWPOSLIN) . AND. ( DX( IXVALZ ) .LT.0,0) )THEN 
DX( IXVALZ )-0.0 

WRITEi*,*)'  lower  position  Halted' 

ENDIP 

C 

RETURN 

END 

C 

- - 
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SUBROUTINE  A2NDACT( X, OX. IXVALZ , IXAUNEW, AUPRTLIA 
(ALWr  ->  LIH,AUPPOSLH,ALWROSLH,  AXBIAS) 


SUBROUTINE  A2NDACT  calculates  a  2nd  order  actuator 
retponte.  This  routine  constructs  a  second  order 
state  space  aodel  using  the  TWOSS  routine,  rate 
Halt  the  signal,  subtract  a  mechanical  bias  and 
position  Halt  the  surface  coanand. 

Creation  date:  27  June  1991 
Revision  date:  11  July  1991 
Owner:  USAP/ASO/APIT/EN 


INCLUDE  'DECLARR.TXT' 

REAL  TPA2,TPB2,TPC2,UPRTL1H,LWRTLIH,UPP0SLIN, LWPOSLIK.XBIAS 
REAL  OX(29),X(29> 

COMMON/ACTVAL2/TPA2 , TPB2 , TPC2 

CALL  TWOSS(X,DX, IXVALZ, IXAUNEW) 


CONVERSION  ROUTINE  -  convert  bias,  rate  and  position 
Halts  to  rad  and  rad/sec  since  the  signal  Is  in  rad  and 
rad/sec 

OTOR  -  3.1415926/180.0 
XBIAS  -  AXBIAS*DTOR 
UPRTLIH  -  AUPBTLIM»DTOR 
LWRTLIH  -  ALWRTLIH»DTOR 
UPPOSLIH  -  AUPPOSL««DTOB 
LWPOSLIH  -  ALWPOSLH»DTOR 


subtract  mechanical  bias  terms 

X( IXVALZ)  •  X( IXVALZ)  -  XBIAS 


rate  and  position  Halt  the  surface  coanands 


ir( (X( IXVALZ+1) .GE.UPRTHM) .AND. (DX( IXVALZ+l) .GT.0.0) )THEN 
DX( IXVALZ>l)-0.0 
ENDir 

IP( (X( IXVALZ  +  l ) .LE.LWRTLIH) .AND. ( DX(  IXVALZ  +  l ) .LT.0.0 ) )THEN 
DX( IXVALZ+1 )-0.0 
ENOIP 

ir( (X( IXVALZ ) .GE.UPPOSLIM) .AND. (DX( IXVALZ)  .GT. 0.0) )THEN 
DX( IXVALZ)-0.0 
ENDir 

If ( (X( IXVALZ ) .LE.LWPOSLIH) .AND. ( DX( IXVALZ)  .LT.0.0 ) )THEN 
DX( IXVALZ)-0.0 
ENDIP 

RETURN 

END 


SUBROUTINE  A4THACT( X, DX, IXVALZ , IXAUNEH, AUPRTLIN, 
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iALWRTLIM,AUPP0SLH,ALWP0SI,M,AXBlA5) 


SUBROUTINE  A4THACT  calculates  a  4th  order  actuator 
response.  This  routine  constructs  a  fourth  order 
state  space  aodel  using  the  roURSS  routine,  rate 
Unit  the  signal,  subtract  a  eechanlcal  bias  and 
position  Halt  the  surface  coeaand. 

Creation  date:  27  June  1991 
Revision  date:  11  July  1991 
Owner:  USAF/ASO/APIT/EN 


INCLUDE  'DECLARB.TXT' 

INTEGER  IXVALZ, IXAUNEW 

REAL  TPA4  ,TPB4,TPC4,TPD4,TPE4,UPRTLIM,LWRTLIM,UPP0SLIM, 
SLHPOSLIN,XBIAS,DTOR 
REAL  DX(29) ,X(29) 

COMMON/ACTVAL4/TPA4 , TPB4 , TPC4 , TPD4 , TPE4 

WRITE!  * , • ) ' DX( IXVALZ) : ' ,DX!  IXVALZ) ,DX( IXVALZ^l ) 

CALL  rOURSS(X, OX. IXVALZ, IXAUNEW) 

WRITE!  •,•)'  DX( IXVALZ) ; ' ,DX! IXVALZ) ,DX!  IXVALZ+1 ) 

CONVERSION  ROUTINE  -  convert  bias,  rate  and  position 
Halts  to  rad  and  rad/sec  since  the  signal  Is  In  rad  and 
rad/sec 

DTOR  -  J. 1415926/180.0 
XBIAS  ••  AXBIAS*DTOR 
UPBTLIN  -  AUPRTLIM«DTOR 
LWRTLIM  -  ALWRTLIK»DTOR 
UPPOSLIM  -  AUPPOSLM*DTOR 
LWPOSLIH  -  ALWPOSLIl‘DTOR 

WRITE!  • , * )UPPOSLIH,UPRTLIH,LWPOSLlH,LWRTLIM 

subtract  aechanlcal  bias  teras 

X!IXVALZ)  -  X!IXVALZ)  -  XBIAS 

rate  and  position  Halt  the  surface  coaaands 


WRITE!*, ‘I'XIIXVALZ), UPPER  POS  LIMIT ’,  X !  I XVALZ ), UPPOSLIM 
WRITE! *,*) ’DX! IXVALZ)  ,DX! IXVALZ) 

WRITE!  •,•) 'X!  IXVALZ) ,LOWER  POS  LIMIT' ,  X!  IXVALZ ), LWPOSLIM 
WRITE! *,•) 'DX! IXVALZ)  ,DX! IXVALZ) 

WRITE!  •,•) 'X! IXVALZ  +  1 ), UPPER  RATE  LIMIT' ,  X !  I XVALZ  +  l ) , UPRTLIM 
WRITE! * , • ) 'DX! IXVALZ+1 )  -' ,DX! IXVALZ+1 ) 

WRITE! •,*) 'X; IXVALZ+1 ) .LOWER  RATE  LIMIT' , X!  IXVALZ  +  1 ), LWRTLIM 
WRITE! •,*) 'DX! IXVALZ+1 )  ,DX! IXVALZ+1 ) 

IP! IXVALZ. E0.9)THEN 
C  WRITE!*, •)'X!9-10)',X!9),X!10) 

ENDIP 

IP! IXVALZ. EO-l 3 )TKEN 
C  WRITE! *,* )'X!1 3-14 )' ,X1 13 ),X! 14) 

ENDIP 

IP!  !X!  IXVALZ  +  1  )  .GE. UPRTLIM)  .AND.  !DX!  IXVALZ  +  1  )  .GT.0.0)  )THEN 
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DX( IXVALZ+1 )-0 .0 
CNDir 

ir((X( IXVALZ+l ) .LB.LWRTLIM) .AND. (DX( ZXVALZ+1 ) . LT.O. 0) )THEN 
DX( IXVALZ+1 )-0 .0 

ENDIf  .  , 

ir( (X( IXVALZ) .GE.UPPOSLIM) .AND. (DX(  IXVALZ)  .  GT  .  0 . 0 ) ) THEN 
DX( IXVAL2)-0. 0 
ENDIP 

ir(  (X( IXVALZ) .LE.LWPOSLIH) .AND. {DX( IXVAL2) .LT.0.0) )THEN 
OX( IXVAL2)-0.0 
ENDtP 

IP(X( IXVAL2+1 ) .GE.UPBTLIN.AND.DX( IXVAL2+1 ) . GT . 0 . 0 ) THEN 
WRITE( •,*) 'UPPER  RATE  LIM  ,  ACT  -  :',IXVAL2 
ENDIP 

IP(X( IXVALZ+1 ) .LE.t-WRTLIM.AND.DX( 1XVAL2+1) .LT. 0.0) THEN 
WR1TE( •,*)’ LOWER  RATE  LIN  ,  ACT  •  :',IXVAL2 
ENDIP 

1P(X( IXVAL2) .GE.UPPOSLIM. AND. DX( IXVALZ ) . GT . 0 . 0 ) THEN 
WRITE( »,*)' UPPER  POS  LIN  ,  ACT  »  :’,1XVAL2 
ENDIP 

ir(X(  IXVAL2) . LE. LWPOSLIM. AND. DX( IXVALZ) .LT.O. 0) THEN 
WBITE( *,») 'LOWER  POS  LIN  ,  ACT  •  IXVALZ 
ENDIP 

C  WRITE(*.‘)'  POSITION  LIMIT  -  OX( IXVALZ)  ',DX(1XVAL2) 

C  WRITE(*,»)'  RATE  LIMIT  -  DX(IXVALZ)  ' , DX( IXVALZ^l  ) 

RETURN 

END 

C 

C 

C 

C  PUNCTIONAL  SUBROUTINES 

C 
C 
C 

C 
C 
C 

c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 

INCLUDE  'DECLARR.TXT' 

REAL  TPAl 
REAL  DX(29),X(29) 

COKMON/ACTVALl/TPAl 

C  hardwlr*  actuator  la^  coefficient  for  lat  order  Modeling 
C  of  higher  order  actuatora  except  the  leading  edge  flap 


SUBROUTINE  ONESS(X,DX, IXVALZ , I XAUNEW ) 


SUBROUTINE  ONESS  provides  a  first  order 
state  space  aodel  representing  a  first  order 
actuator 


Pori 


0(t) 

I(t) 


TPA 

S  ♦  TPA 


Creation  date;  28  June  1991 
Revision  date:  11  July  1991 
Ovner:  USAP/ASD/APIT/EN 
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IP<IXVALZ.NE.29)THEN 
TPAl  -  20.2 
ELSE 

TPAl  -  16.0 
ENDIP 


DX(IXVALZ)  -  -TPA1*X(IXVALZ)  ♦  TPAl*AUNEW(  IXAUNEW) 

IP( IXVALZ.NE.29)THEN 
DXdXVALZ  >  1)  •  0.0 

OXdXVALZ  *  2)  -  0.0 

DXdXVALZ  *  3)  -  0.0 

ENOIP 

RETURN 

END 


SUBROUTINE  TWOSS(X. OX, IXVALZ , IXAUNEW) 


SUBROUTINE  TWOSS  provldtc  •  (ccond  order 
•  tat*  apaca  nodel  ceprese.'^tlng  a  second  order 
actuator 

Pora:  0(t)  TPA 


I(  t)  S*2  -fTPBS  ♦TPC 


Creation  date:  28  June  1991 
Revision  date:  11  July  1991 
Owner:  USAP/ASD/APIT/EN 


INCLUDE  'DECLARR.TXT' 

REAL  TPA2,TPB2,TPC2 
REAL  DX(29) ,X(29) 

COMMON/ACTVAL2/TPA2 , TP82 , TPC2 

DXdXVALZ)  -  XdXVALZ  *  1) 

DXdXVALZ  ♦  1)  -  -T?B2*XdXVALZ*l)  -  TPC2*XdXVALZ ) 
TPA2*AUNEHdXANEW) 

DX(IXVALZ  >  2)  •  0.0 
DXdXVALZ  ♦  3)  -  0.0 

RETURN 

END 


SUBROUTINE  POURSS ( X , DX , IXVALZ , IXAUNEW) 


SUBROUTINE  POURSS  provides  a  fourth  order 
State  space  aodel  representing  a  fourth  order 
actuator 

Pora:  0(t)  TPA 


X(t)  S*4  ♦TPBS*3  ♦TPCS'Z  ♦  TPDS  ♦  TPE 
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Creation  date:  28  June  1991 
Revision  date:  11  July  1991 
Owner:  USAr/ASO/APIT/EN 


INCLUDE  'DECLARR.TXT* 

REAL  TPA4,TPB4,TPC4,TPD4,TPE4 
REAL  DX(29),X(29) 

COMMON/ACTVAL4/TPA4 ,TPB4 , TPC4 , TPD4 , TPE4 
WR I TE (*.*) 'ACTUATOR  CONSTANTS' 

WBITE( • )TPA4,TPB4,TPC4.TPD4 ,TPE4 

OX(IXVALZ)  -  XdXVALZ  *  1) 

DXdXVALZ  ♦  1)  -  XdXVALZ  *  2) 

DXdXVALZ  ♦  2)  -  XdXVALZ  *  3) 

DXdXVALZ  +  3)  -  -TPE4*XdXVALZ)  -  TPD4»XdXVALZ  ♦  1) 

4-TPC4 ‘XdXVALZ  ♦  2)  -  TPB4*XdXVALZ  ♦  3)  ♦  TPA4*AUNEWdXAUNEW) 

RETURN 

END 
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SUBROUTINE  KF 1 LT( T, X, DX) 

Subroutina  to  incorporat*  the  Xalaan  filter  Into  the  loop. 


INCLUDE  • DECLARR.TXT' 


local  variables 


REAL  AWORR(14,l),BWORK(14.1) 

REAL  XHP(14) <XHH(14),GKP(14,7),X(29),DX(29) 
REAL  PRBOLO(20,1S) .PRBTMP(20,1S) ,ZXHH( 14,20) 
REAL  PHIX( 14,14) ,BD( 14 , 6 ) . ZXHP ( 14 , 20 ) 

INTEGER  I,J,X,IPLTR 

SAVE  ZXHM,PRBOLD,PRBTNP,ZXRP 


-  Set  PRBOLD  to  the  last  probabilities  from  last  tiae  throu9h  and 

zero  out  PRBTMP. 


IP  ( (Ban)(fla9.eq.l)  .and.  (  initv2.eq.0) )  THEN 
DO  17S1  ti-4,nfltr(bank) 

PRBOLDf  t  i ,  ban)i )  -PRBNEW(  t  i  ,  banli ) 

PRBTNP(  ti,ban)i)-0.0 
1781  Continue 
Initv2-1 
END  IP 


-  If  this  is  the  first  call  to  KPILT  after  the  start  of  a  tlae 

response  loop,  inidicated  with  INITV>1,  initialize  variables. 
Do  to  20  for  hierarchical  aodelinq. 


IP  (INITV.EQ.l)  THEN 
DO  20  1-1,20 

DO  10  J-1,14 
ZXHP( J.I )-0. 

ZXHN(J,I)-0. 

10  CONTINUE 

IP  ( (I.ne.aodelnl)  .and.  ( I  .ne .aodeln2 ) 

*  .and.  (I.ne.aodelnl))  THEN 

PRB0LD(  I  ,Banl< )-( 1  ,-PRBPLTRTO  )/PLOAT(  NPLTR(  Ban)r )  -4  ) 
IP  (I.eq.4)  PRBOLD(I,Banl()-PRBPLTRT0 
PRBTMP  (  I,  Ban)l)-0. 

END  IP 

20  CONTINUE 
INITV-0 
END  IP 


-  Calculate  new  xhat-f  (XHP)  and  un-noraallzed  probabilties  (PRBTMP) 

(i.e.,  nuaerator  of  equation  10-104  of  Naybec)(  --  for  our  iapleaentation 
we  can  either  strip  off  the  beta  tera  or  leave  as  is  by  setting  the 
BETAPLG  to  0  or  1,  respectively)  by  calls  to  UPDATE  for  each  of  the 
NPLTR  total  eleaental  filters. 

-  Alno  calculate  the  weighted  sua  of  Xhat^  (XHPSUN),  which  is  done  by 

a  call  to  ADPCON  which  is  then  passed  to  CONTROLLER  to  coapute  the 
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input  to  th«  actuotort  (AUNCW). 


DO  100  IPLTR-l,NPLTR<Bank) 

IP  ( ( IPLTR.ne.nodelnl)  .and.  ( IPLTR.na .■odeln2 ) 

.and.  (IPLTR.na.aodaln3) )  THEN 

CALL  I1TXC2 1  (  ZXHH ,  XHH ,14,20,1  PLTR  ,1,0) 

CALL  MTXC21(2XHP,XHP,14,20,IPLTR,1,0) 

CALL  MTXC 3 2  <  ZGKP , GXP , 1 4 , 7 , 20 , 1 PLTR ,  bank , 0 ) 

CALL  UPDATE ( XHM , XHP , GRP, PRBTMP , PRBOLD, I PLTR , T ) 

CALL  HTXC21 ( ZXHP,XHP, 14 , 20 , IPLTR,  1 , 1 ) 

END  IP 
100  CONTINUE 


-  Calculate  the  weighted  sua  Xhat+  (XHPSUM). 


CALL  ADPCON(PRBTKP, PRBOLD, ZXHP) 


-  Calculate  the  control  vector  (AUNEW). 


CALL  CNTRL(T,X,DX) 


-  Propagate  eatiaate  forward  in  tiae  (create  a  new  Xhat-) 

but  do  not  propagate  it  for  the  actual  aircraft 
configuation  (indicated  by  aodelnl,  aodeln2,  and  aodeln3.) 


DO  200  R-l,NPLTR(Bank) 

IP  ( (K.ne. aodelnl)  .and.  (K.ne.aodeln2) 

*  .and.  (K.ne.aodeln3) )  THEN 

CALL  MTXC21(ZXHP,XHP,14,20,K,1,0) 

CALL  HTXC32(ZBD,BD,14,6,20,K,bank,0) 

CALL  MTXC32(ZPHIX,PHIX,14,14,20,K,bank,0) 
CALL  HATHL(PHIX,XHP,AHORR,14,14,l) 

CALL  NATHL(BD,AUNEW,BWORK,14,6,l) 

CALL  HATAD(AHORR,BWORK, XHH, 14,1) 

CALL  NTXC2 1 ( ZXHH , XHH , 14, 20, K, 1,1) 

//////////////////////////////////////////////////// 

CODE  CHECR 

//////////////////////////////////////////////////// 
IP(  (T.GE.3.0).AND.(T.LE.3.3) )THEN 
IP(R.E0.4 )THEN 

wbite(18,*)'rpilter  #',k.'  at  time  ',T 

WRITE( 18, • ) 'XHP' ,XHP 
WRITE( 18,») 'PHIX' ,PH1X 
WRITEi 18,*) 'AWORK' ,AHORR 
WRITE(18,*)'BD  ',BD 
WRITE( 18, • ) 'AUNEW' ,AUNEW 
WRITE( 18, • ) 'BWORK' ,BWORK 
WRITE( 18, •) 'XHH' ,XHH 
HRITE( 18, •) 'ZXHH' ,ZXHH 
ENDIP 
END  IP 
END  IP 
200  CONTINUE 

RETURN 


END  XPILT 


END 
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SUBROUTINE  UPDATE( XHN, XHP. CKF , PRBTHP , PRBOLD, 1 FLTR , T ) 


Subroutln*  called  fee*  XPILT  that  updates  the  atate  eatlaates 
uein9  the  lateat  aeaeureMent  vector,  it  alao  calculatea  the 
realduale,  the  individual  acalar  reaiduala,  and  the  probability 


INCLUDE  'DECLARR.TXT' 


local  variablaa 


INTEGER  INDX,irAIL,IPLTR,lTEHPZZ, ITEHPBAZ 

REAL  CWORK ( 7,1), DWORR (7,1), EWORK (14,1), PWORR (1,7), GWORK (1,1) 
REAL  XHM( 14) ,XHP(14).GRP(14,7),RESID(7,1) ,TRES1D(1,7) 

REAL  PRBOLD(20,15),PRBTMP(20,15) ,AR(7,7) , ARINV( 7 , 7 ) , TMPl 

declaration  for  code  checliin9  variables 

REAL  hfltdua(7,8),xfltduB(e,l),xfltstat(7,l)- 
REAL  hfltcon(7.6)  ,xfltcon(6, 1) ,zfltcon(7,l ) 

double  precision  ssqqrt 
double  precision  suarakr(7) 
double  precision  Ck,Cl(l 
integer  jk 


itiae 

k  *  « 

The  current  tiae. 

rakr 

m 

The  residual  vector  transpose  tiaes  the  Ak 
inverse  aatrlx  tiaes  the  residual  vector. 

Ijk 

m 

Indicates  which  Monte  Carlo  iteration  is 
in  progress. 

■ 

m 

Nuaber  of  sensors. 

suarakr 

k  *  * 

The  sua  of  rakr  used  in  the  Log  Likelihood 
calculation. 

■-7.0 

P1-3.141S92654 


Zero  out  suarakr  array. 


Do  11  Jk-1,7 

suarak  r ( jk )>0 . 0 
11  Continue 


-  Update  Xhat-  with  latest  aeasureaent  data. 

so  that  Xhat+-Xhat-  ♦  K{s  -  HXhat-1 


CALL  KTXC32(ZH,H,7,14,20, IPLTR,bank,0) 

CALL  KATI1L(H,XHH, CWORK, 7, 14,1) 

CW0RK(4,1 )-0.0 
CWORK(7,1)-0.0 

/////////////////////////////////////////////////////// 
CODE  CHECK 

////////////////////////////////////////////////////// 

1P( (T.GE.3.0).ANO.(T.Le.3.3) )THEN 
ZP(lPLTR.EQ.4>THeN 

WRITE(18,»)'PILTER  l',irLTR 
WRITE(18,*)'H  ',H 
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c  WRITE(18,*1*XHM' ,XH« 

C  WRITEdS, S 

C  ENDIP 

C  ENDIP 

*  ///////////////////////////////////////////////////// 

CALL  HATSB(1,CW0RR,DW0RR,7,1) 

IP( (T.GE. 2.95) .AND. (T.LE. 3.3) )THEN 
IP( IPLTR.EQ.S)THEN 

do  lfltdua«l,7 
do  jfltdua>1.6 

hfltdu»( ifltdu*. J<ltdu«)-h( IfltduN, jfltdu*) 

•  nddo 

•  nddo 

do  Ifltdua  «  1.6 

xfltdua( If iCduN, 1 )-xhB( Ifltdua) 

•  nddo 

CALL  NATHL(hfltdu»,xfltduB.<fltttBt,7,a,l) 

writ«(19,*)'filt«r  15  *tat*  portion  of  )\*x)i«t-' 
writ«(19,*)'tlB*,  h' 

%»rit*(19,*)t,hfltdu« 

*»rlt«(19,«)'  X  ' 
wrlt«( 19 , • )xf ltdu» 
wrlt*(19,*)'  »  ' 
wtit«(19,»)*flt*tat 

C  controller  portion  bro)c*n  out  of  h  aatrlx  for  c)»»ck 

do  lfltdua>l,7 
do  jfltdua«1.6 

hfltcondfltdua, jfltdua)-))(lfltdua. jfltdua  *  6) 

•  nddo 

•  nddo 

do  Ifltdua  «  1,6 

xfltcondfltdua,l)-xha(  Ifltdua  *  8) 

•  nddo 

CALL  HATHLChfltcon.xf Itcon, ifltcon,7,6, 1 ) 

wrlted9,*)'fllt«r  15  controller  portion  of  h»x)iat-' 

vrltod9,»)'tlao,  h' 

wrlted9,«)t,hfltcon 

wrltod9,*)'  X  ' 

wr  1  ted9.  *  )xfltcon 

»frlted9,»)'  »  ' 

wrltoi 19, • )xf Itcon 

C  WRITEd9,*)T,Z(7),CWORR(7,l),DWORK(7,l) 

ENDIP 

ENDIP 

•/////////////////////////////////////////////////////////* 

•  Modification  for  bias  calculation 

•/////////////////////////////////////////////////////////* 

•  correction  for  bias  In  LH  Stabllator 

If ( (IPLTR.EQ.S) .AND. (T.CT.3.0) )THEN 
DW0RK(7,1)-DW0RR(7,1)  ♦  0.008 
End  If 
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CALL  MATML  <  GK f , OWORK . EWORK ,14,7,1) 

CALL  HATAD<XHH,eHORK,XHP,14,l) 


. . . . . . 

C  -  Calculate  the  raaidualt 

C 

C  -  Also  calculate  the  sin9le  scalar  residuals 

C  **T  •  (AR)*-1  •  R 

C  for  only  two  of  the  ten  Monte  Carlo  loops  (1  and  7) 

C  Stored  in  IIARR( ti«e; rl , r2 , r 3 ,  r4 ,  r5, r6 , r7 ; loopl  or  7;filter  id) 
C 

C  -  These  sin9le  scalar  residuals  are  not  currently  used  for 

C  decision  as)<in9  processes  in  the  code.  They  are  here  to 
C  verify,  correct  identification  conver9ence 

C  of  the  currently  iepleaented  HHAESIH,  which  strips  off  the 
C  beta  tera. 

. . . . . . . 

. . . . . 

C  -  Get  the  individual  AR  inverse  out  of  stors9e. 


CALL  MTXC32<2ARlNV,ARIMV,7,7,20,irLTR,banlt,0) 
CALL  MTXC3 2 ( ZAR , AR , 7 , 7 , 20 , I PLTR , bank , 0 ) 


. . . . . 

C  -  Calculate  each  of  the  seven  residual  vector  components. 

. . 

DO  10  INOX-1,7 

RESID(IN0X,1)-Z(1NDX)-CW0RR(INDX,1) 

TRESIOi 1 , INOX)-RESID( INDX, 1 ) 
iteapbaz-lf ltr-3 
IP  (IJR.EQ.l)  THEN 

RSSAVE( itime, indx, ltempbaz)-RESID(  INOX,  1 ) 

BU  Z  S AVE ( i t i me , i ndx , 1 1 empba  s )  - 2 . 0  *  SORT ( AR ( I NDX , I NDX ) ) 

c  write(*,»)' -  update  - ',itlme 

c  write ( * , * ibussavei itlme, indx, itempbas) , indx,  itempbas 

c  write( *,• )ak( indx, Indx) 

END  IP 


. . . . . . 

C  -  Taka  sln9le  scalar  residuals  for  loops  1  and  7 

. . . . . . . 


♦ 


IP  ((ijk.eq.l)  .or.  (ijk.eq.7))  THEN 

rakr( ltime,indx,ljk,IPLTR)-(resid(indx,l)»»2)» 

akinv( indx, indx) 

END  IP 


10  CONTINUE 


. . . . . . . 

C  -  Calculate  the  individual  probability  coefficient 

C  (numerator  of  Eq'n  10-104  of  Haybeck  V.2.) 

. . . . . 

CALL  MATHL(TRESID,ARINV,PW0RR,1,7,7) 

CALL  MATML( PWORR , resid,GHORR, 1 ,7,1) 


. . . . . . . . . . . 

C  -  Recall,  ZDETAR  contains  the  determinant  of  AR. 

C  These  were  determined  separately  in  Hatrixx  and  read  in 
C  subroutine  GETDAT. 


C-45 


c 

C  Although  GWORK  la  daflnad  at  an  array,  it  it  roally  tha  tcalar 

C  ttra  r  T  •  Akinv  *  r.  It  waa  dafinad  at  an  array  tinea  it  la  tha 

C  raault  of  tha  aatria  ■ultlplicationa  abova. 

C* **•**•»*•*•**•»•••***•**•**••****»****»>*•*****»»*••**»*•*»»•*»»***• 


TMPl-(-.5)»GWORK(l,l) 

IP  (THPl.te.-SO. >  THPl-(-50.) 
taqqrt-tqrt(  aba(zdatak( iPLTR.Bank) )  ) 

C  writa(*.*)‘ltiaa,  ifltr:  ‘ , itiaa, ifltr 

C  wri ta( * , * i ' aaqqrt:  '.aaqqrt 

. . . 

C  -  Racall,  if  BETAPLG  it  0,  tha  bata  tara  la  atrlppad  off 

C  if  BETAPLG  it  1,  tha  bata  tara  raaalnt 

C  If  for  aoaa  raaton  BETAPLG  it  aoaathing  alaa,  tha  dafault 
C  will  atrip  off  tha  bata  tara 

C* ••*•*•***«*****<«**•«•*************************•**•******•*•*•*****• 

C  writa(*,»)'pl,  a:  '.pi,  a 

Ckl»aaqqrt*(2.0»pl ) •*(a/2 . 0 ) 

C  writa(»,*)'ckl:  ',ckl 

Ck-log(ckl) 

IP  ( BETAPLG. na. 1 )  Ckl-1 
C  writa(«,») 'ck,  ckl:  ',ck,ckl 

PRBTMP(  IPLTR, Bank )-( PRBOLDf IPLTR, Bank ) ‘EXPi TMPl ) )/Ckl 

C********************************************************************** 

C  -  Now  dateraina  whathar  aantor  failura  axlata  uaing  tha  devalopaant 

C  on  pagaa  229-231  of  Hayback  v.l.  uta  Equation  S-67,  tatting 
C  NwlO.  Kara  Ck>Log(ckl)  (Log-natural  logarltha)  whara  ckl  it 

C  dafinad  abova. 

C 

C  Plrat,  tua  tha  kth  caaidual  and  kth  diagonal  tara  of  Ak(tj) 

C  froa  j-i-N«l  to  i,  whara  i  it  tha  currant  tlaa  indax  (ti,  hart 

C  callad  'itiaa'). 

C  Nota,  wa  hava  to  tkip  tha  firat  tan  (N-10)  Incraaantt  to 
C  wa  can  bagin  tuaalng  at  tiae-0. 

C  Haro,  'Indx'  takaa  tha  placo  of  'k'  in  Eq'n  5-67. 

C  Nota,  '7'  in  tha  indx  loop,  it  tha  nuabar  of  rowa  in  tha  H  aatrix. 

C  Do  thia  for  tha  firat  Honta  Carlo  itaration  (ljk-1). 


C  IP  (ijk.na.l)  go  to  30 

C  IP  ( i t iaa . It . 10 )  go  to  30 

C  DO  20  jk-(itiaa-104^1), itiaa 

C  DO  IS  indx-1,7 

C  auarakri indx)-tuarakr(  indx)  *  rak r ( jk , indx , i jk , I PLTR ) 

C  IP  ( auarak r ( indx ) .gt . 1 . a30 )  auarakr ( indx ) -1 . 0E30 

C  Lk  ( Itlao, indx, IPLTR)-Ck-0 . 5*auarakr ( indx ) 

C  15  CONTINUE 

C  20  CONTINUE 

C  30  CONTINUE 

RETURN 


C  END  UPDATE 

C-— —  —  —  — . 
C— .  —  —  -  —  -  —  —  — 

END 
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SUBROUTINE  ACALC( ZXHP, P. BORDER , ICNT ) 
INCLUDE  ‘DECLARR.TXT' 


C . 

C  local  variablaa 
C . 

INTEGER  PORDER( 20 . IS ) . ICNT( 1 S  )  , I ,  J 

REAL  ZXHP( 14,20) .P(20, IS) 


C _ 

C*  ********** . ********************* . **************** . 

C  -  Calculata  tha  weiohtad  au*  of  tha  atata  aatiaata,  XHPSUH. 

C  Kara,  tha  J  loop  loopa  through  8  tlaaa,  which  la  tha  nuabar  of 

C  plant  atataa.  ICNT  dapanda  on  what  aathod  of  calculation  la 

C  to  ba  uaad  aa  dataralnad  In  ADPCON. 

C* ******************************************************************* 

DO  20  J-1,14 
XHPSUN( J)-0. 

DO  10  1-1,  lCNT(Ban)t) 

IP  ( ( 1 .na.aodalnl)  .and.  ( I .na .•odaln2 ) 

>  .and.  ( I . na . aodaln) ) )  THEN 

XHPSUH( J)-XHPSUN( J)« 

*  (ZXHP(  j,PORDER(  I  ,Banl()  )*P(POROER(  I ,  Ban)i ) ,  Ban)( ) ) 

IP  (XHPSUNt j) .gt.  l.OalS)  XBPSUH(l)-  l.OalS 
IP  (XHPSUM(j) .It. -l.OalS)  XHPSUHCj)— l.OalS 
END  IP 
10  CONTINUE 
20  CONTINUE 

RETURN 


C  END  ACALC 

c— —————— ————— « 

END 


C-47 


uuuuuuu  u  uuuuuuuuoouu 


SUBROUTINE  COMMANO(rBC,rAC,rPC,T) 

-  Provide!  the  viete  flight  control  lystea  [CNTRL.rOR] 

with  the  coeaand  eignale  for  the  longitudinal  axle 
(FBCl,  the  lateral  coamand  (PRC),  and  the  directional 
coamand  (PPC).  Additionally,  glaulatlon  results  have 
Indicated  the  need  for  a  dither  signal  to  "shake  up* 
the  systea  and  aid  the  filters  In  their  Identification 
tasks . 

INCLUDE  'DECLARR.TXT' 

REAL  PEC , PAC, PPC , DON, T, oaegal , oaegaZ , oaegaS 


SAVE 

CONNAND  SIGNALS 


Dither  signal  generation 

--NOTE:  If  a  control  coamand  Is  to  be  used, 

it  aust  be  added  to  the  below 
created  dither  signal. 


PULSED  DITHER  SIGNAL 
NON  -  SUBLIMINAL 


Don-aaod( t , 3 . 0 ) 

c  IP(  ( Don. ge. 0.0). and. (Don. It. 0.1 25) )TRBN 

c  PEC  -  13.5 

c  PAC  -  -7.5 

c  PPC  -  24.0 

c  ELSE  IP( (Don.ge.0. 125)  .and. (Don. It .0 . 25) )THEN 

c  PEC  —13.0 

C  PAC  -  7.5 

c  PPC  —24.0 

C  ELSE 

c  PEC  -  0.0 

c  PAC  -  0.0 

C  PPC  -  0.0 

C  END  IP 

C 

C . 

C 

c 

C  PULSED  DITHER  SIGNAL 

C 

C  SUBLIMINAL 

C . 

C 

C  Don-aaod( t , 3 .0 ) 

IP( ( Don. ge .0.0) .and. ( Don . 1 t . 0 . 125 ) )THEN 
PEC  •16.2 
PAC  -  -7.0 
PPC  -  30.0 

ELSE  1P( (Don.ge.0. 125) .and. (Don. It. 0.25) )THEN 
PEC  —17.5 
PAC  -  7.5 

PPC  -  30.0 
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ELSE 

EEC  -  0.0 
PAC  >0.0 
PPC  -  0.0 
END  IP 


SINUSOIDAL  DITHER  SIGNAL 


PREQUENCT 

oaegal  >  IS.O 
oaegal  -  IS.O 
oaegaJ  •  IS.O 

SIGNAL 


If ( t .ga . 3 . 4 ) than 

PEC-  12.0*aln(OBagal*t) 

IP( PEC. LT. 0.0) PEC-12. S*ain(OBagal*t) 
PAC-  -11.0*aln(OBaga2*t) 

PPC-  30.0*tln(OBaga3*t) 

alta  18/20. S/-7/22 

PEC-28. 0*sin(oaagal*t) 

IP( PEC. LT. 0.0) pec-30. S*ain(oBagal*t) 
PAC-  -7.0*fin(oBaga2»t) 

PPC-  22.0*ain(oBaga3*t) 

andlf 


USER  DBPINED  DITHER  SIGNAL 


Don-aBod( t , 3.0) 

IP( (Don.ga.O.O) .and. (Don.lt.0.1 ) )THEN 
PEC  -  IS. 2 

PAC  -  16.0 

PPC  -  SS.O 

ELSE  1P( (Don.ga.O.l) .and. (Don.lt.0.12S) )THEN 
PEC  -  (-lS.2/0.025)»(Don  -  0.1)  ♦  15.2 

PAC  -  (-16.0/0.025)*(Don  -  0.1)  ♦  16.0 

PPC  -  (-55.0/0.025)*(Don  -  0.1)  *  55.0 

ELSE  IP( (Don. ga. 0.125). and. (Don. It. 0.3) )THEN 
PEC  —16.5 
PAC  —14.0 
PPC  —50.0 

ELSE  I P ( ( Don . ga . 0 . 3 ) . and . ( Don . 1 1 . 0 . 3 25 ) ) THEN 
PEC  -  ( 16.5/0.025)»(Don  -  0.3)  -  16.5 

PAC  -  ( 14.0/0.02S)*(Don  -  0.3)  -  14.0 

PPC  -  ( 50.0/0.025) ‘(Don  -  0.3)  -  50.0 

ELSE 

PEC  -  0.0 
PAC  -0.0 
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c  rpc  -  0.0 

C  END  IP 

c . 

C  . 

c 

C  PILOT  PURPOSEfUL  CONMANDS 
C 

C . 

C  Pitch  Path 

C  IP((t.GT.2.95) .and. ( t .LT. J. 15 ) )THEN 

C  PEC-13. S 

C  PAC-20.0 

C  PPC— 40.0 

C  ENOIP 

C  1P( (T.GT.6.0) .and. (t.LT. 6.15) )THEN 

c  rEC-16.5 

C  PAC— 15.0 

C  PPC-20, 

C  ELSE  1 P ( ( T . GE . 6 . 15 ) . AND . ( T. LT . 6 . 3 ) ) THEN 

C  PAC- 15 

C  PPC— 20. 

C  ENDIP 

C  Roll  Path 

C  Yaw  Path 

RETURN 

END 

SUBROUTINE  COPYNT( A, B, N, H) 

. . . 

C  THIS  ROUTINE  COPIES  A  REAL  HATRIX  A  INTO  REAL  MATRIX  B. 

C  BOTH  MATRICES  ARE  OP  DIMENSION  N  BY  M . 

(;«•*•*****•**•*«****•*••••***•••*•******•*•*•*••***•**•»*•*»***•*.*»*• 

c 

INTEGER  I.O.N.H 
REAL  A(N,N) ,B(N,N) 

DO  100  I-l.N 
DO  100  J-l.H 

B(I,J)-A(I,J) 

100  CONTINUE 
RETURN 
C/ 

C///////////////////////////////////////////////////////////////////// 

C  END  COPYMT 

C— — —  —  —  —  —  —  —  — 

END 
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r>  o  o  n  rt  n  oooooo 


SUBROUTINE  OSORT( Values . NuMval , INDEX) 


-  This  subroutine  sorts  the  probabilities  frost  hi9hest  to  lowest. 

Here,  Values  -  PRBNEH 
Nuaval  -  NFLTR 
INDEX  •  BORDER 


INCLUDE  'DECLARR.TXT' 


local  variables 


INTEGER  Nuaval(lS),INDEX(20,15; ,ITHP,IC,J,R 
REAL  Values(20,lS).VTMP(20),TEHP 


DO  10  J-1 , Nuaval ( Bank ) 

IP  ( ( J . ne .Bodelnl)  .and.  ( J . ne . ■odeln2  ) 

*  .and.  ( J . ne . aodelnS ) )  THEN 

VTMP( j)-va lues ( j. Bank) 

INDEX! J,Bank)«J 
END  IP 
0  CONTINUE 

IC"Nuaval ( bank ) 

K-1 


IP  ((IC.GE.4)  .and.  (K.CT.O))  THEN 

J«1 
K-0 

30  IP  ( ( J . e<] .aodelnl )  .or.  ( J . eq.aodeln2 )  .or.  ( J . eq . aodeln3 ) ) 

*  90  to  31 

IP  ( J.LE. ( IC-1 ) )  THEN 

IP  (VTMP(J) .LT.VTMPCJ+l) )  THEN 

TEHP-VTHP( J) 

VTMP( J)-VTMP( J*l) 

VTMP( J+1 )-TEMP 
ITNP«INDEX( J,Bank) 

INDEX! J, Bank )«INDEX(J+1,  Bank) 

INDEX! J+1, Bank) -ITHP 
K-1 

END  IP 

31  CONTINUE 

J-J  +  1 
GOTO  30 

END  IP 

IC-IC-1 
GOTO  20 

END  IP 

RETURN 


END  DSORT 


END 
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SUBROUTINE  GAUS SGEN ( I  DUN , VLENGTH , VECTOR ) 


C  . . . 

C  SUBROUTINE  GAUSSGEN  -  use*  function*  GASDEV  and 
C  RANI  to  9*netate  a  vector  of  rando*  variable*  with 
C  a  noraal  distribution  -  zero  mean  and  variance  of 
C  one.  Tests  indicate  that  the  result*  ar*  9ood  in 
C  th*  on*  and  two  *i9ma  bound*  for  vector  l*n9th* 

C  of  1000  or  9reat*r.  Th*  function*  GASDEV  and 
C  RANI  COD*  froa  ’Numerical  Recipe*’,  written  by: 

C  William  H.  Press,  Brian  P.  Flannery,  Saul  A. 

C  Teukolsky,  William  T.  Vetterlin9,  CamDr!d9e  Press, 

C  1986. 

C 

C 

C  Subroutine  GAUSSGEN 
C  Created;  2S  July  1991 
C  Revised:  26  July  1991 
C 

C  Owner:  USAF/ASD/APIT/ENY 
C 

C 

REAL  VECTOR! 10), SUMVECT 
INTEGER  lOUH 
INTEGER  VLENGTH 

C  do  loop  to  fill  array  vector  with  random  numbers  in 
C  a  9ausslan  distribution 

DO  I-:, VLENGTH 

VECTOR! I )-GASDEV| lOUH) 

SUNVECT  -  SUMVECT  *  VECTOR! I) 

ENDDO 

C  the  mean  i*  calculated 

ZMEAN  -  SUHVECT/FLOAT! VLENGTH) 

C  the  variance  is  calculated 
DO  I-l, VLENGTH 

ZDUH  -  (VECTOR(I)  -  2HEAN)**2. 

SUMZDUH  -  SUHZOUM  ♦  ZDUM 
ENDDO 

SUHZDUH  -  SUHZDUH/FLOAT(VLENGTH) 

SIUJtA-SQRTl  SUHZDUM) 


RETURN 

END 

C 

FUNCTION  GASDEV! IDUH) 


The  function*  GASDEV  and  RANI  come  from  ’Numerical 
Recipes’,  written  by:  William  H.  Press,  Brian  P. 
Flannery,  Saul  A.  Teukolsky,  William  T. 

Vetterlin9,  Cambrid9e  Press,  1986. 


DATA  I  SET/0/ 

IF! 1SET.EO-0)THEN 
1  Vl-2  . ’RANK  IDUH)-)  . 

V2-2.’RAN1(IDUH)-1. 
R»V1”2  ♦  V2»*2 
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ir(R.GE.l. )G0  TO  1 
PAC-SQRT(-2.*LOG(R)/R) 

GSET-Vl*rAC 

GASDEV-V2*rAC 

ISET>1 

ELSE 

GASDEV-GSET 

ISET-0 

ENDIP 

RETURN 

END 

C 

PUNCTION  RANI (I DUN) 

C  Th«  functions  GASDEV  and  RANI  coat  froa  'Nuaerical  * 

C  Recipes",  written  by:  Mllliaa  H.  Press,  Brian  P.  * 

C  Plannery,  Saul  A.  Teukolsky,  Willlaa  T.  * 

C  Vetterllng,  Caabrid9e  Press,  1986.  • 

C  * 

C  *********************************************** •*»*•• 

DIMENSION  R(97) 

PARAMETER  ( M1-2S9200 , IAl-714 1 , ICl-5477 3 , RMl-3 . 8580247E-06 ) 
PARAMETER  ( M2-1 344S6 , IA2-81 21 , IC2-284 1 1 , RM2-7 . 4 37 3773E-06 ) 
PARAMETER  ( M3-243000 , IA3>4561 , IC3-S1 349 ) 

DATA  IP P/0/ 

IP(IDUM.LT.O.OR.IPP.EQ.O)  THEN 
lPP-1 

IXl-MOD( IC1-IDUN,N1) 

IX1-M0D(IA1»IX1*IC1,M1) 

IX2-MOD( IX1,M2) 

IXl-NOO(  IAl*IXl4^ICl,Nl  ) 

1X3-N00( IX1,M3) 

DO  11  J-l,97 

IXl  -  N00(  lAl^IXl'flCl.Nl) 

1X2  -  MODI  IA2*IX2-fIC2,R2) 

R( J)-(PLOAT(lXl)+PLOAT( 1X2 ) •RM2 ) "RMl 
11  CONTINUE 

IDUM-l 
ENDIP 

IXl-MOD( IA1"IX1*IC1,M1) 

IX2-MOD( IA2*IX2+IC2,H2) 

1X3-N0D( IA3*IX3+1C3,M3) 

J-1+(97*IX3)/M3 

IP(  J.GT.97.0R.  J.LT.DPAUSE 

RAN1-R( J) 

R( J)-( PLOAT( IXl )>PLOAT( 1X2 ) "RM2 ) *RN1 

RETURN 

END 
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c 


SUBROUTINE  GETDAT 


INCLUDE  'OECLARR.TXT' 

C . 

C  local  variablas 
C . 

INTEGER 

C . 

C  Read  in  the  Input  data  (ilea 
C . 


CALL  REDNAME 
CALL  REDPLAG 
CALL  REDREAL 


C . 

CALL  REOHAT 
C . 


Do  iq«l,NUNBANKS 
Banknaae(  iq)-Df  ile(  ( Iq^-S) ,  Iq) 

ENDDO 

C  HRlTEt*,*)'  banknaKes  '.BANKNAME 

RETURN 

Z////////////////// ////////////////////////////////////// ///////////// 

C  END  GETDAT 

C—  — —  >  — 

END 
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SUBROUTINE  HATHL( A, B, C, L. N, N ) 

C  This  set  of  subroutines  is  bein9  chan9ed  to  sequentially  reduced 
C  the  tiae  la9  between  failures.  See  Subroutine  GETDAT 


C» »»»»*»»*****»• *»»*•***»»»•*»•*»****»**»»****»*• 

C  THIS  ROUTINE  WILL  MULTIPLY  TWO  REAL  MATRICES 
C  A-AN  L  BY  M  MATRIX 
C  B-AN  M  BY  N  MATRIX 
C  C-THE  L  BY  N  PRODUCT  OP  A  AND  B 

C  NOTE  ACTUAL  ARGUMENT  C  MUST  DIPPER  PROM  A  AND  B 
»»»**»*»*»*•»*• 


C/// //////////////////////////////////////////////////// ////////////// 
C//  THIS  ROUTINE  PROVIDES  SINGLE  PRECISION  BOUNDS  CHECKING  POR  VAX 
C//  OPERATION  BY  USING  A  REAL* 16  VALUE  POR  CALCULATING  THE  NEW 

C//  ELEMENT  IN  THE  C  MATRIX.  IP  THIS  VALUE  EXCEEDS  THE  SINGLE 

C//  PRECISION  LIMIT,  IT  IS  PORCED  TO  THE  SINGLE  PRECISION  LIMIT. 
INTEGER  I,J,R,L,H,N 
REAL  A(L,M),B(M.N).C(L,N) 

REAL*16  CTEMP.SIGN 

C _  _ 


DO  200  I-1,L 
DO  200  J-1,N 
CTEMP-0. 

DO  100  R'l.M 

CTEMP-CTEMP+QEXT(A( I,R) ) ‘QEXTi B ( K , J ) ) 

100  CONTINUE 

1P(QABS(CTEMP) .GT.l .Q38)  THEN 
SIGN-1. 

IP(CTEMP.LT.O)  SlGN-(-l.) 

CTEHP-S1GN*1.E38 
END  IP 

C( I,J)-SNGLQ(CTEHP) 

200  CONTINUE 
RETURN 
C/ 

C/ //////////// //////////////////////////////////////////////////////// 

C  END  MATML 

C-.— 

END 


SUBROUTINE  MATAD( A, B, C, L, M ) 

C* ****••••*•**••**••*********•••*******••*•*•*•*•***••****•*•****•*•* 

C  THIS  ROUTINE  ADDS  TWO  REAL  MATRICES  OP  DIMENSION  L  BY  N 
C  A  AND  B  ARE  THE  INPUTS,  C  IS  THE  SUN 

C* •*•*•*••*••**••*•*••*••*•••*•••**•****••*********•*•••***•********* 

INTEGER  I,J,L,N 

REAL  A<L,N),B(L,N),C(L,N) 

DO  100  I-1,L 
DO  100  J-1,H 

C(I,J)-A(I,J)+B(I,J) 

100  CONTINUE 
RETURN 
C/ 

Z/ /////////////////////////////////////////////////////////////////// 

C  END  MATAD 

C— —  —  —  —  — — 
END 
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ono  non  n  nnnnnnnnnnnnnnnnnnnn 


SUBROUT I N E  MATS AV (UNIT, NAM E,NR,H,N,IMG, XR BAL , X I MAG , F ORMT ) 


Writes  a  file  in  MATRixx  readable  foraat 

Paraneters: 

unit  INTEGER 

naae  CHARACTER( • ) * 

nr  INTEGER 

■  INTEGER 

n  INTEGER 

iM9  INTEGER 

xreal  DOUBLE  PRECISION 

xiaag  DOUBLE  PRECISION 

forat  CHARACTER»(*) 


INTEGER  UNIT, M,N, NR, IMG 
CHARACTER* (« )  NAME,rORMT 
DOUBLE  PRECISION  XREAL( NR, * ) , XIMAGC NR , *  ) 
CHARACTER  NAM* 10 , PORM*20 

NAM'NAME 

PORM-PORMT 

MRITE(UNIT, ' (AlO, 3IS,A20) * ) NAM , M , N , IMG , FORM 
Write  the  real  part  of  the  aatrix 

WRITE( UNIT, FORM)  ( ( XREAL( I , J ) , 1-1 , M ) , J-1 , N ) 
Write  the  imaginary  part  of  the  aatrix 
IF  (IHG.NE.O)  THEN 

WRITE( UNIT, FORM)  ( ( X1MAG( I , J ) , I-l , N ) , J-1 , N ) 
END  IF 

RETURN 

END 


Fortran  logical  unit  for  file 
Name  for  file.  One  alpha  followed  by 
up  to  10  charactere 
Row  diaencion  in  calling  program 
Row  dimension  for  aatrix 
Column  dimension  for  aatrix 
If  iag-0,  imaginary  part  (xiaag) 
is  assumed  to  be  sero 
Real  part  of  the  aatrix  to  bo  saved 
Imaginary  part  of  the  aatrix 
String  containing  the  format  to  be 
used  in  writing  the  aatrix 
' ( 1P3E25 . 17 ) '  for  machine  Independent 
'(10A6)'  for  fast  compact 
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SUBROUTINE  HATSB ( A, B, C, L ,M ) 

C* ******************************************************************** 

C  THIS  ROUTINE  SUBTRACTS  REAL  MATRIX  B  RROH  REAL  MATRIX  A 
C  DirPERENCE  IS  RETURNED  IN  REAL  MATRIX  C. 

C  ALL  THREE  MATRICES  ARE  OP  DIMENSION  L  BY  H 

C********************************************************************* 

c 

INTEGER  I,J,L.N 

REAL  A(L.M) ,B(L,M),C(L,M) 

DO  100  I«1,L 
DO  100  J-1,M 

C(l.J)-A(I,J)-B(I.O) 

100  CONTINUE 
RETURN 
C/ 

r./////////////// /////////////////////////////////// //////////////////// 

C  END  MATSB 

C— —  —  .  —  —  •  —  — 

END 


SUBROUTINE  NATTP( A, B, H. N ) 

C* 

C  THIS  ROUTINE  TRANSPOSES  A  MXN  REAL  MATRIX  A  AND  STORES  IN  B 

c 

INTEGER  I,J,N.N 
REAL  A(H,N) ,B(M.N) 

DO  100  I-1,N 
DO  100  J«1,N 
PRINT*, 1 ,J 

B(J,I)-A(I,J) 

100  CONTINUE 
RETURN 
C/ 

^//////// ////////////////////////// /////////////////////////////////// 

C  END  MATTP 

C—.—i  — 

END 


SUBROUTINE  MTXC21 (AVEC, BVEC, I  ROW, ICOL , I  SLICE , BANKER , IDR ) 
INCLUDE  'DECLARR.TXT' 

C  —  ROUTINE  TO  CONVERT  BETWEEN  VECTOR  AND  2  DIMENSIONAL  ARRAYS 
C  IP  IDR-0  2D  TO  VECTOR  CONVERSION 

C  IP  IDR-1  VECTOR  TO  20  CONVERSION 

C  -  Hltracchlcal  Nodelin9  Variablta 

Int«9ar  bankar 

INTEGER  IROW, ICOL, ISLICE, IDR, IR 
REAL  AVEC< IROW, ICOL, BANKER) ,BVEC( IROW) 

C  _ 


DO  10  1R«1,IR0W 

1P( IDR.EQ.O)  BVEC( IR)-AVEC( IR , ISLICE, BANKER) 

IP( IDR.EQ. 1)  AVEC( IR, I  SLICE, BANKER )-BVEC( IR) 

10  CONTINUE 
RETURN 

C// 

c///////////////////////////////////////////////////////////////////// 

C  END  MTXC21 

C».  — ............................................................... 

END 
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SUBROUTINE  HTXC32 ( AVEC . BVEC, IROW, ICOL, lOFTH, ISLICE,  BANKER, IDR) 
INCLUDE  •  DECLARR.TXT' 

C  -  ROUTINE  TO  CONVERT  BETWEEN  2  AND  3  DIMENSIONAL  ARRAYS 

C  ir  IDR-O  30  TO  20  CONVERSION 
C  IP  IOR-1  2D  TO  30  CONVERSION 

C  -  Hlecarchlcal  Hodelin9  varlablas 

Intagar  bankar 

INTEGER  IRON, ICOL.IDPTH.ISLICE, IDR, IC,IR 

REAL  AVEC ( I RON , I COL , I DPTH , NUNBANKS ) , BVEC ( I ROW ,  I COL ) 

C  _ 


DO  10  IC-1,IC0L 

DO  10  1R-1,IR0N 

IP(IDR.EQ.O)  than 

C  AV;£C(  i  r,  ic,  lal  lea,  banka  r  )-AVEC(  lr,ic,isllca,l) 

BVEC(IR,IC)-AVEC(IR,IC,ISLICE, BANKER) 
and  If 

IP( IDR.EQ.l)  AVEC( I R, 1C , I SLICE , BANKER ) -BVEC ( IR, IC ) 


10  CONTINUE 

C  Pauaa  'wa  ara  raturnin9  fron  ■txc32' 

RETURN 

C// 

C//////////// //////////////////////////////////////////// ///////////// 

C  END  HTXC32 

C— . 

END 


SUBROUTINE  HTXOMP( A, IR, IC, NAME ) 

C  ..».*****«••..*••*«*••*•*•*•*«*»*»» 

INTEGER  IR, IC, lOX, JDX 
REAL  A( IR, 1C) 

CHARACTER*6  NAME 

C _ _ 


HRITE(71,9010)NAME 
DO  10  10X-1,IR 

IPdC.LE.B)  THEN 

HRITE(71,9000)<A(IDX, JDX) ,JDX-1,IC) 

ELSE 

WRITE(71,9000)(A(1DX, JDX) ,JDX-1,8) 

WRITE! 71,9000) (A( IDX, JDX) , JDX-9,IC) 

END  IP 

10  CONTINUE 

9000  PORMAT!'  ' ,8(E12.S.2X) ) 

9010  PORMAT ( ’ 0 ' , A6 , '  ////////////////////////////////// ' ) 

RETURN 

c///////// //////////////////////////// ////////////////////////// 

c  END  HTXOMP 

C— ————— ———— ——————————————— 

END 
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SUBROUTINE  REDFLAG 


SUBROUTINE  REOPLAG  loadt  •  coMMon  block  of  l09ic«l  * 
fla9B  used  throu9hout  HNAESIN  to  control  the  * 

pco9rae  execution.  The  data  is  loaded  into  an  * 

array  (ATEMP]  after  readin9  file  PLAG5.DAT.  An  • 
equivalence  stateeent  relates  the  values  of  the  * 
[ATEMP]  array  with  lo9ical  fla9  naees  used  in  the  * 
pro9ra*.  * 

* 

Creation  date:  B  July  1991  * 

Revision  date:  28  July  1991  • 

• 

Owner:  OSAP/ASD/AF IT  * 


INCLUDE  'DECLARR.TXT' 


C . 

C  local  variables 
C . 

C  declaration  of  variable  types 

INTEGER  ATEHP(39) 

character*80  line 

C  equivalence  and  coeeon  block  statements 

EQUIVALENCE  ( ATEMP ( 1 ) , I 01 0 ) , { ATEMP ( 2 ) , HOOELN ) , 

4 ( ATEMP ( 3  )  , MODELNl ) , ( ATEMP ( 4 ) , M0DELN2 ) , ( ATEMP ( S ) , M0DELN3 ) , 

4 ( ATEMP ( 6 ) , I  START) , ( ATEMP ( 7 ) , NPLAG ) , ( ATEMP ( 8 ) , NUMPAI L8 ) , 

4(ATEMP(9) .NUHBANRS) , ( ATEMP ( 10 ), BANK ) , ( ATEMP( 1 1 > , HI ERARCHY ) , 
4(ATEMP( 12) ,XITER), (ATEMP(13),SENS0RBIAS), (ATEMP(14) .PLTRTO)  , 
4(ATEMP(15),NPLTB(1)),(ATEMP(16),NPLTR(2) ),{ATEMP(17),NFLTR(3)), 
4(ATENP( 18) .NPLTR(4) ) ,(ATEMP( 19) ,NPLTR(S) ) , ( ATEMP( 20 ) ,NPLTR(  6 ) ) , 
4(ATEMP( 21 ) ,NPLTR(7) ) , ( ATEMP( 22 ) ,NPLTR( 8 ) ) , (ATEMP< 23 ) ,NPLTR(  9 ) )  , 
4(ATEMP(24),NPLTR(10)),(ATENP(25),NPLTR(11)).(ATENP(26),NPLTR(12)), 
4( ATEMP ( 27 ) ,NPLTR( 13) ) , ( ATEMP ( 28 ) ,NPLTR( 14 ) ) , (ATEMP( 29 ) .NPLTR( 15) ) , 
4(ATEMP( 30) .BANKFLAG) , (ATEMP( 31 ), INITV2) , ( ATEMP( 32 ) , INITV) , 

4(ATEMP( 33) .lACTORDR) , ( ATEMP ( 34 ), BETAPLG) , ( ATEMP ( 35) .ITRIMZ) , 

4 ( ATEMP ( 36) ,ISLCT) , (ATEMP( 37) ,DSEED) , (ATEMP( 38) , lACTPAIL) , 

4(ATEMP( 39) ,IACTFL2) 

C  initialization  of  variables 

ICOUNTR  -  0 

C  main  proqraa 

OPEN'  (  UN  I T- 1 1 ,  F I LE- '  FLAGS  .  DAT '  ,  STATUS-  ’  UNKNOWN '  ) 

DO  HHILE(1C0UNTR.LT.39) 

READ(11,'(A)')  LINE 
IF(LINE<1:1).EQ.'  ' )THEN 
ICOUNTR  -  ICOUNTR-fl 
LOCATION  -  INDEX! LINE, '-' )♦! 

READ*  LINE( LOCATION: ) , • ) ATEMP ( ICOUNTR ) 

ENOIP 

ENDDO 

C  output  check  -  used  for  debuqqinq 
C  NRITE(»,*)  ATEMP 
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C  HRITE( • , • ) lOlD.HOOeLN.HODELNl ,HODBLN2,MOOeLN3, ISTART.WrLAG, 

C  tNUHFA  I  LS.N’JMB  AUKS,  BANK,  HIERARCHY,  XI  TER,  HGNrAC.PRBMlN, 

C  4SENSOBBIAS,rLTBT0,NPILT(l) ,NPII.T(2) ,NPILT(3) ,NPILT(4) ,NPILT(5) , 

c  tNriLT(6) ,NriLT(7 ) ,NPILT(8) ,NriLT(9) , NPI Ll ( 10 ) , NP I LT( 1 1 ) , 

C  4NPILT(12),NPILT(13),NPILT(14),NPILT(15) ,BANRPLAG, INITV2, INITV . 

C  4IPAR,LIW, LRW, INPO( 1 ) , INPO( 2 ) , INPO( 3) , INPO( 4 ) , IHORK , RPAR , RWORK , 

C  4IACT0RDR,N,BETAPLG, ITRINZ, ISLCT, lACTFAIL, 1ACTPL2 

C  Wrltt<*,*)  lactordr ,a,b*taf I9, i t fiat , 1 Blct , iactfal 1 

CLOSEdl ) 

RETURN 

END 
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SUBROUTINE  RCDHAT 


SUBROUTINE  REDNAT  Is  CRll«d  froa  SUbroutin*  CETDAT 
and  loads  into  a  coMon  block  tha  data  arrays  for 
th#  (rl  aatrix  -  (ZA),  tha  (B]  aatrlx  -  (ZB),  tha 
stata  transition  satrls  (PHI)  -  ZPHI,  ... 


CREATION  DATE)  12  JULV  1991 
REVISION  DATE:  22  JULY  1991 

OWNER:  USAP/ASD/APIT  -  Wright  Pattarson  APB 


INCLUDE  'DECLARR.TXT' 

C . 

C  local  variablas 
C . 

CHARACTER*80  LINE 

LINE  -  'C' 

C . 


DO  IBANKZ-1 .NUHBANRS 
L-IBANRZ 

DO  K-l.NPLTR(IBANKZ) 

OPEN(UNIT«9,PILE-DPILE(K, I BANKZ) .STATUS- 'OLD' ) 
C  HRITE(«,»)'  BANR  -  '.IBANRZ,'  PILTER  -  ',K 

C  HRITE(*.*)'DPILE  -  DPI LE( K , IBANRZ ) 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


DO  1-1,7 

REAO(9,'(A132)')LINE 

ENDDO 

READ(9,*)( (ZA(1,J,R,L),I-1,8),J-1,8) 
READ(9.'(A132)' )LINE 
REAO(9, *)<  <ZB(I,J,R,L),I-1,8),J-1,6) 
READ(9, ' (A132)' )LINE 

REAO(9,*)(  (ZPHIXd,  J,R,L),I-1,14),  J-1,14) 
READ(9.'(A132)')LINE 

BEA0(9,*)({ZBD{I,J,R,L).I-1,14),J-1,6) 

REAO(9,'(A132)')LINE 

READ ( 9, * ) ( ( ZCQDCN( I,J,K,L),I-1,8),J-1,8) 
READ(9,'(A132)')L1NE 

READ(9,»)( (ZH(I,J,K,L),I-l,7),J-l,l4) 
HR1TE(*,»)'  R  -  ' ,ZH(4,1,K,L) 
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c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


READ(9,'(A13J)')tlNE 

READ(9,*)((ZGRE(I,J,*.I<>.I-1.1<).J-1>3) 

READ(9,'(A132)* )LINE 

READ(9,»)( (ZR(I,J.K,I.).I-1.7) ,J-1,7) 
WR1TE(»,»)'  *  -  ' 

READ(9.'(A132)‘)LINE 

READ (9,*1((IAR(I.J,E.L),I-1,7),J-1,7) 
«RITE(».*)'  EAR  -  '  .IAK(7,7,R,I.) 

READ(9,'(A132)' )LINE 

REA0(9.*)( (2AR1NV(1,J,K,L), 1-1,7 ),J-1,7) 
«RITE(».*)*  2AK1NV  -  ' , 2ARINV( 7 , 7 , K , L ) 

REA0(9,MA132)')(.INE 

READ(9,*)2DETAK(R,I.) 

WRITE(»,»)2DETAR(K,1.) 


ENDOO 

ENDOO 

CLOSE(9) 

RETURN 

END 
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SUBROUTINE  REDREAL 


SUBROUTINE  REDREAL  load*  a  coABon  block  of  raal 
flag*  u«*d  throughout  NHAESIH  to  control  tha 
prograa  axacutlon.  Th*  data  i*  loaded  Into  an 
array  (ATEMpj  after  reading  file  PLAGS.DAT.  An 
equivalence  atatcaent  relate*  th*  value*  of  th* 
[ATEMP]  array  with  logical  flag  naee*  u*ed  In  th* 
prograa. 

Creation  date:  8  July  1991 
Reviaion  date:  9  July  1991 

Owner!  USAP/ASD/APIT 


INCLUDE  'DECLARR.TXT' 

C . 

C  local  variable* 
C . 


CMARACTER*aO  LINE 
REAL  RTEHP(22) 

DOUBLE  PRECISION  OPTEHP(l) 

EQUIVALENCE  (  RTEHP( 1 )  ,TSANP) , ( RTEHP ( 2 ) , PRBNIN ) , 
t ( RTERP  (  3 )  ,  PRBF LTRTO ) , ( RTEMP( 4 ) , DSIN )  ,  (  RTEMP ( 5 ) , WCNPAC  )  , 

( ( RTEHP ( 6 ) , ZBIASAHNT(  1 )  )  ,  ( RTEHP ( 7 ) , ZBIASAMNT( 2  > ) , 

« ( RTEHP  (  8 )  ,  ZBIASAMNT( 3  )  ) , ( RTENP( 9 ) , ZBIASAMNT( 4 )  )  , 

4(RTEHP(  10)  ,ZBIASAMNT(S)  ) , ( RTEHP( 1 1 ) , Z8IASAHNT( 6 ) ) , 
t(RTEHP(  12)  ,ZBIASAHNT(7) ) . ( RTEHP( 1 3 )  , TIHBLACl ) . 

4 ( RTEHK 1 4 )  ,  TI HELAG2  ) , ( RTEHP( 1 5 ) , TSIGl I ) ,  (  RTEMP ( 18 ) , 
4TSIG22 ) ,  (  RTEHP( 17 ) .TSIG33 ) , ( RTEHP(  18 ) , TSIG44 ) , (RTEHP ( 19 ) , 
4TSIG55) ,  (RTEHP<  20) ,TSIG86),(BTEHP(21 ) ,TSIG77 ) , (RTEMP(22) , 
4TSIGe8) 

EQUIVALENCE  (  OPTEHP( 1 ) , H ) 


I COUNT  -  0 

OPEN(UNIT-12.PILe>'REAL5.DAr'  ,  STATUS- '  UNKNOWN '  ) 
DO  NHILE(  1COUNT.lt. 22) 

READ(12, ' (A) ' )  line 
IP(LINE(1:1).EQ.'  ' )THEN 
I COUNT  -  ICOUNTel 
LOCATION  -  1NDEX(LINE, )-rl 
READ! LINE( LOCATION:  )  . * )RTEHP( ICOUNT) 

ENOIP 

ENDDO 

ICOUNT  -  0 

DO  HHILE(ICOUNT.LT.l) 

READ) 12, ' (A) '  )  LINE 
ir(LINE(l:l).EQ.'  ' )THEN 
ICOUNT  -  1 COUNT* 1 
LOCATION  -  1NDEX(LINE, '-' )♦! 

READ(  LINE( LOCATION:  )  , • )DPTEHP( ICOUNT) 

ENDIP 

ENDDO 

C  output  aectlon  uaed  for  debugging 
C  WR1TE(»,*)'TSIG11,TSIG88  ' , TSIGl 1 , TSIGSO 

C  WRITE(»,*)'M  -  ',M 

CLOSE(12) 

RETURN 

END 
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o  u  o  u  u  u 


SUBROUTINE  REDNAME 


SUBROUTINE  REONAKE  loads  a  couon  block  of  charactar 
nases  usad  thcou9hout  HKAESIH  to  control  tha 
raadln9  of  tha  ptopar  data  filas.  Tha  flltar  names 
are  stored  in  tha  DEILE  array  and  loadad  into  a 
common  block. 


Craation  data:  10  July  1991 
Ravision  data:  11  July  1991 

Ownar:  USAP/ASD/APIT 


INCLUDE  'OECLARR.TXT' 


local  variablas 


daclaration  of  variabla  types 
INTEGER  ICOUNTR, JCOUNTR 

character*80  line 

equivalence  and  common  block  statements 


C  Initialization  of  variables 

ICOUNTR  -  0 
JCOUNTR  -  0 
C  main  pro9ram 

OPEN ( UN I T- 1 3 , P I LE> ' PLTRNAME . DAT ' , STATUS- ' UNKNOWN ' ) 

DO  HHILE( JCOUNTR.lt. 15) 

JCOUNTR  -  JCOUNTR  ♦  1 
DO  WHILE( ICOUNTR.lt. 20) 

READ(13,*(A)')  LINE 
IP(LINE(1:1).EQ.'  ' )THEN 
ICOUNTR  -  IC00NTR4-1 
LOCATION  -  INDEX! LINE, '-') *2 

READ! LINE! LOCATION: ) . ' !A) ' )DPILE! ICOUNTR, JCOUNTR) 
C  WRITE! )DPILE(ICOUNTR, JCOUNTR) 

BNDIP 

ENDDO 

ICOUNTR  -  0 
ENDDO 

C  output  check  -  used  for  debuqqinq 

CLOSE! 13) 

RETURN 

END 
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SUBROUTINE  SHUL( A, B, C. L, N ) 

C********************************* . . 

C  THIS  ROUTINE  MULTIPLIES  A  REAL  MATRIX  BY  A  REAL  SCALAR 
C  A-  THE  SCALAR 
C  B-  THE  MATRIX 
C  C-  THE  PRODUCT 

C  B  AND  C  ARE  OP  DIMENSION  L  BY  M 

C********************************************************************* 

c 

INTEGER  I.J.L.H 
REAL  A,B(L.N),C(L,H) 

DO  100  I-1,L 
DO  100  J-1,M 

C(1,J)-A»B(I,J) 

100  CONTINUE 
RETURN 
C/ 

c/////// ////////////////////////////////// ////////////////////////////// 

c  END  SMUL 

C-..  — —  —  —  —  —  — 

END 
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SUBROUTINE  TEHPORAL( RSSAVE , TEHPAVG ) 
*////////////////////////////////////////////////////* 

*  Calculate*  the  teaporal  aveta9e  of  the  residual*  * 

*  within  each  of  the  eleaiental  filter*  * 

*  ////////////////////////////////////////////////////  • 

Real  Tiipav9 , Tapavoa , Tmpavgb, Tapav9C , Tapav9d 
Real  Teapav9( 192 , 7 , 13 ) .Teaphold 
Integer  IIM00,IZ,JZ 

Include  'Oeclarr.txt' 


Do  IIHOD  •  1,13 
Do  JZ  -  1,7 
Do  IZ  -  1,64 

Tapavg  •  RSSAVE(  IZ  ,.}Z,  1 IMOD)  +  Tapavg 
Enddo 

Tapavga  ••  Tapavg 
Do  12  -  65,126 

Tapavg  •  RSSAVE(  IZ,JZ,  IIHOD)  4-  Tapavg 
Enddo 

Tapavgb  <•  Tapavg 
Do  IZ  -  129,192 

Tapavg  •  RSSAVE( IZ,JZ, IIHOD)  *  Tapavg 
Enddo 

Tapavgc  •  Tapavg 
DO  IZ  -  1,192 

Teaphold  •  (rlost(IZ)/64.0)  ♦  1.0 
If(IZ.le.64)th*n 

Teapavg(TEHPHOLD,JZ, IIHOD)  •  Tapavg* 
End  If 

lf( (lZ.9t.64).and.)IZ.l*.128))th*n 
T*apavg(TENPKOLD,JZ, IIHOD)  -  Tapavgb 
Endlf 

lf( (IZ.gt.l28) .and. (IZ.le. 192) ) then 
Teapavg(TEHPHOLD,JZ, IIHOD)  •  Tapavgc 
Endlf 


Enddo 

Enddo 

Enddo 

Return 

•//////////////////////////////////////////////////////• 

•  * 

•//////////////////////////////////////////////////////* 

End 
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APPENDIX  D:  MATRIXx  MACROS 


These  macros  were  used  to  create  the  filter  files  aod  plot  the  results.  Matrix^  (15J  resides  on  the  Flight 
Dynamics  VAX  computer.  The  routines  are  included  in  the  end  of  this  appendix.  Each  of  the  routines  are 
described  within  this  appendix. 

The  Filecreate  routine  accessess  the  other  Matrix^  routines.  This  routine  calls  MTX.MXX  and  the 
SETUPXX  routines.  The  SETUPXX  routines  set  up  each  of  the  appropriate  banks  by  operating  on  the  data 
loaded  within  Matrix^.  The  SETUPXX  routines  include  the  hypothesized  failure  for  each  hank  and  filter.  Each 
filter  within  bank  1  hypothesizes  a  single  failure.  Bank  2  assumes  a  left  stabilator  failure.  Thus  every  filter 
within  bank  2  assumes  a  left  stabilator  failure  and  another  failure  corresponding  to  the  filter  designation.  The 
bank  numbers  range  from  B1  -  B9,  and  then  the  designations  change  to  XO  -  X3.  Data  files  for  the  fiilly- 
functional  aircraft  model  elemental  filter  for  the  MMAE  can  be  found  in  Appendix  E.  A  MMAE  simulation 
users  manual  guides  the  reader  through  the  design  aod  running  of  the  simulation.  The  users  manual  can  be 
obtained  through  Dr.  Peter  Maybeck,  Department  of  Electrical  Engineering,  Air  Force  Institute  of  Technology, 
WPAFB,  OH. 
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riLBCKBATB.HXX  HATRXXX  EXECUTABLE  NACBO 


// 

// 

// 

//  Authoci  Capt  Gragory  L.  Stcatton 

//  Data  craatad:  2S  Auguat  1991 

//  Data  ravitad:  27  Saptaabar  1991 

// 

//  Thia  aacro  ccaatas  avary  (iltar  flla  for  aach  bank  for  tha 
//  MKABSI'^  prograa.  Balow  ara  liatad  tha  variablat  that  naad  to 
//  raalda  In  NATRIXX  aaaory  bafora  axacutlon: 

// 

//  forig.  Tha  8x8  plant  aatrlx  (A  aatrix) 

//  borig,  Tha  8x6  control  aatrix  (B  aatrix) 

//  horig,  Tha  7x14  aaaauraaant  aquation  aatrix  (H  aatrix) 

//  r,  Tha  7x7  aanaor  covarianca  aatrix 

//  q,  Tha  6x6  whita  Gausaian  noiaa  covarianca  aatrix 

//  g,  Tha  8x6  whita  noiaa  aultipliar  aatrix 

// 

//  Thia  aacro  calla  the  aacroa  "aetupbn . axx*  (where  n  ia  tha  bank 
//  nuabar),  which  in  turn  craatea  tha  filaa  for  that  particular  bank. 
//  In  all,  13  filtara  for  aach  of  tha  13  banka  ara  craatad. 

// 

//  Each  filter  file  ia  aat  up  ao  that  it  aay  alao  be  copied  into  filaa 
//  rOlBn.dat,  r02Bn.dat,  or  r03Bn.dat  and  uaad  aa  truth  aodala  of  hard 
//  failuraa.  Soft  failure  truth  aodala  auat  be  generated  aaparataly. 
// 

// 

//  START  MACRO 

// 

// 

//  Sat  up  initial  conatanta 
// 

n-14j 

dalt-1/64 ; 
rxl4>0*onaa( 1 , 14 ) ; 
cx8>0*onea(8 , 1 ) ; 
cil4-0*onea( 14,1); 

act-diag( (20.2,20.2,20.2,20.2,20.2,16) ) ; 
aa>forig; 

baug>( 0*onaa( 8 ,6  )  ;act i ; 
faug-(aa,borig;0*onaa(6,8) ,-act) ; 
g.(g;0*onea(6,6) ) ; 
gd-aya( 14 ) ; 

// 

//  Sat  up  P,  B,  and  H  aatricea  for  bank  1  filtara 
// 

bank"l ; 

f con-faug ; 

bcon^baug ; 

bbcon'borig; 

hcon>horlg; 

axac ( ' aatupbl . axx ' ) 

// 

//return 

// 

//  Sat  up  P,  B,  and  H  aatricea  for  bank  2  filtara 
//  where  actuator  1  haa  been  deterained  to  be  failed 
// 

bank>2 ; 
fcon>faug; 

//fcon( ; ,9)-cxl4; 

bcon-baug; 

b(  ; ,  1  )>cxl4; 

bbcon^borig; 

bbcon( : , 1 )>ca8; 

hcon»>iorlg; 
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tx«c( 'sttupb2.axx' ) 

// 

//  S«t  up  T,  B.  «nd  H  aatclccs  for  bank  3  filtart 
//  whtra  actuator  2  haa  baan  datarainad  to  ba  fallad 
// 

bank>3} 

fcon-fau9i 

//fcon( t , 10)>cfl4f 

bcon-bau9i 

b( I ,2)-ctl4| 

bbcon^borlgi 

bbcon( I ,2)>cs8) 

hcon>hori9i 

axac( 'satupb3.axx' ) 

// 

//  Sat  up  f,  B,  and  R  aatricaa  for  bank  4  filtara 
//  whara  actuator  3  haa  baan  dataralnad  to  ba  fallad 


// 

banka4 I 
fcon«fau9} 

//fcon( ; , 11 )>cxl4  t 

bcon«bau9; 

b( I ,3)>csl4) 

bbcon-bori9j 

bbcon( I , 3)-ca8) 

hcon-horl9; 

axac( 'aatupb4 .axx' ) 

// 

//  Sat  up  P,  B,  and  R  aatricaa  for  bank  S  filtara 
//  whara  actuator  4  haa  baan  dataralnad  to  ba  fallad 
// 

bank-S« 

fcon>fau9) 

//fcon( i ,i2)«cal4) 

bcon>bau9) 

b( i,4)-cxl4; 

bbcon-borl9i 

bbcon( t , 4 )«cs8 ; 

hcon>horl9> 

axac( 'aatupbS.axx' ) 

// 

//  Sat  up  f,  B,  and  R  aatricaa  for  bank  6  filtara 
//  whara  actuator  5  haa  baan  dataralnad  to  ba  fallad 


// 

bank-6 ; 

fcon-fau9i 

//fcon( I ,13)-cil4; 

bcon-bau9) 

b(  I ,S)-cxl4; 

bbcon-borl9; 

bbcon( : ,5)-ca8; 

hcon-horl9; 

axac( ' aatupbS.axx' ) 

// 

//  Sat  up  r,  B,  and  R  aatricaa  for  bank  7  filtara 
//  whara  aenaor  1  haa  baan  dataralnad  to  ba  fallad 


// 

bank-7; 

fcon-fau9; 

bcon-bau9i 

bbcon-borl9; 

hcon-hori9; 

hcon( 1 , t )-rzl4  ; 

axaci ' aatupb7 .axx' ) 

// 

//  Sat  up  P,  B,  and  R  aatricaa  for  bank  8  filtara 
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■atricc*  for  bank  9  flltara 
baan  dataralnad  to  ba  failad 


■atrlcaa  for  bank  10  flltara 
baan  dataralnad  to  ba  failad 


//  whara  sanaor  2  hat  baan  dataralnad  to  ba  failad 
// 

bank-8  > 

fcon-fau9i 

bcon-bau9i 

bbcon-borl9) 

hcon-horl9i 

hcon(2, I )-rsl4; 

axac( ' aatupbS .Kxx' ) 

//  Sat  up  r.  B,  and  B 
//  whara  tantor  3  hat 
// 

bank-9 > 
fcon-fau9) 
bcon-bau9; 
bbcon-borl9} 
hcon-horl9t 
hcon( 3, : )-rtl4; 
axac( ' aatupbO .>xx' ) 

//  Sat  up  f,  B,  and  H 
//  whara  tantor  4  hat 

// 

bank-lOi 
fcon-fau9} 
bcon-bau9; 
bbcon-borl9} 
hcon-horl9} 
hcon(4, I )-rtl4i 
axac( 'tatupxO.nxx' ) 

// 

//  Sat  up  r,  B.  and  H 
//  whara  tantor  S  hat 
// 

bank-11 ) 
fcon*fau9; 
bcon-bau9; 
bbcon-borl9; 
hcon-hori9« 
hcon(S, ) )-rtl4 I 
axac( 'tatupxl .axx' ) 

// 

//  Sat  up  r,  B,  and  H 
//  whara  tantor  6  hat 
// 

bank-13) 
fcon-f8U9; 
bcon-bau9) 
bbcon-borl9) 
hcon-horl9) 
hcon(6, I )-rxl4) 
axac( 'tatupx2.mxx' ) 

// 

//  Sat  up  r,  B,  and  H 
//  whara  tantor  7  hat 
// 

bank-13) 
fcon-fau9) 
bcon-bau9) 
bbcon-borl9) 
hcon-horl9) 
hcon(7, : )-rxl4) 
axoc( '8ttupx3.kxx' ) 

// 

//  Sot  up  r,  B,  and  H 


natricat  for  bank  11  flltara 
baan  dataralnad  to  ba  failad 


■atrlcaa  for  bank  12  flltara 
boon  dattralnad  to  ba  failad 


■atrlcaa  for  bank  13  flltara 
baan  dataralnad  to  ba  failad 


■atrlcaa  for  bank  7  flltara 
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//  whtrt  actuator  6  haa  baan  datacainad  to  ba  fallad 

//  Thia  aactlon  haa  baan  coMantad  out 
//  Originally  thia  ganaratad  bank  7  flltara 
//  It  la  now  aat  to  ba  bank  14  i<  avar  uaad 
// 

//bank>14) 

//fcon>faugi 
////fcon( ! ,14)«cxl4) 

//bcon-baugi 
//b( t ,6)-csl4) 

//bbcon>borig) 

//bbcon( : ,6)-cz8; 

//hcon-horigj 
//axac( '8atupx4.axx' ) 

// 

// 

raturn 

// 
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//  RESIDUAL  PLOTTING  MACRO  for  HMABSIN  RESULTS 
// 

//  This  aacro  plota  rasldual  roculta  fora  aaaaaia  quickly 
//  and  ganerataa  filas  for  printing  at  a  futura  data. 

// 

raf f»RS( : , 1 1 7 )  I 
bdup-BDU( 1.1:7)) 
bdlw>-l .0*bdup) 

//ralB-RS( 1 ,8:14)) 

//bduls-BDU( 1,8:14)) 

//bdllB— 1.0*BDU( 1.8:14)) 

//rara>R8( i ,15:31) ) 

//bdurB-80U(  1.15:21 > I 
//bdlra— 1.0*BDU( 1.15:21)) 

//ralf-RS( 1,33:28)) 

//bdulf-BOU( : ,22:28)) 

//bdllf— 1.0*8DU( 1.32:28)) 

//rarf«RS( i ,29:  35) ) 

//bdurf-BOU( :. 29:35)) 

//bdlrf— 1.0*BDU( 1,39:35)) 

//rsrd-RS(:,36!42)) 

//bdurd-80U( 1,36:42)) 

//bdlrd— 1.0*BDU( 1,36:42)) 

// 

//  fully  functional  filtar 
// 

ravl>(k>dup( :  ,1)  ,bdlw(  :,l),raff(:,l)) 
rtv3«i bdupi :,2),bdlw(:,2),raff(:,2)j 
rav3«(bdup( : , 3 ) ,bdlw( :,3),raff(:,3)i 
rav4>ibdup( i,4),bdlw(:,4),rsff(:,4)i 
ravS«(bdup( i ,5) ,bdlw( : ,5) ,caff(  i  ,5)  ] 
rav6>ibdup( : ,6 ) ,bdlw( : ,6) , rsf f ( :  ,6 ) ] 
rav7-(bdup(i,7),bdlw{i,T),raff(:,7)) 

// 

// 


plot( ta, ravl , ' ti tla/Valocity  Sansor  caOl/,.. 
xlabal/tiaa  ( aaconds )/. . . 
ylabal/raaidual  valua/’)) 
nard( ' raaidpltl .dat* ) 

// 

plot(  ta,  rav2,  ’ titla/Angla  of  Attack  Sanaor  caOl/. . . 
xlabal/Tiaa  ( aaconda )/. . . 
ylabal/raaidual  valua/')) 
nard( ' raaidplt2 .dat' ) 

// 

plot(  ta,  rav3 , ' titla/Pitc)t  Rata  Sanaor  caOl/. . . 
xlabal/Tiaa  (aaconda)/... 
ylabal/raaidual  valua/')) 
nard( ' raaidpltl .dat' ) 

// 

plot(ta,  rav4, 'titla/Noraal  Accalaration  Sanaor  caOl/... 
xlabal/Tiaa  (aaconda)/... 
ylabal/raaidual  valua/')) 
hard ('raaidplt4.dat') 

// 

plot( ta, ravS, ' tl tla/Roll  Rata  Sanaor  caOl/. . . 
xlabal/Tiaa  (aaconda)/... 
ylabal/raaidual  valua/')) 
hard( ’ raaldplt5.dat' ) 

// 

plot(  ta,  rav6 , '  titla/Yaw  Rata  Sanaor  caOl/. . . 
xlabal/Tiaa  (aaconda)/... 
ylabal/raaidual  valua/')) 
nard( ' raaidplt6.dat' ) 

// 
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plot(t>,rav7, 'titlc/Latcral  Acceleration  Senior  ciOl/. . 
xlebel/Tiee  (eeconds)/. . • 
ylebel/reelduil  value/' )i 
hard( ' realdplt? .dat' ) 

// 

return 


// 

// 

// 


left  atabilator 


of  Attack  Senior  ca02/. . 


Acceleration  Sensor  ca02/. 


ravl*(rsls(i,l) .bdulsi >  < 1 ) >bdlla( >>1)1 
rav2>{ rail ( I , 2) .bdulsi i,2),bdlla(i>2)) 
rsv3>lrsla(if3) .bdulsi i , 3) ,bdlla( t , 3 ) ) 
rsv4-( ralai t , 4 ) ,bdula( i,4),bdlla(j,4)j 
rsvS>irala(i , 5) <bduls( t , 5),bclla( > / S) 1 
rav6»| ralai i >( ) .bdulai t<S)>bdllB(<>S)] 
rsv7>i  ralai i ,7 ) .bdulai t ,7) ,bdlls( i , 7 )  J 

plot(ta,ravl,'tltle/Veloclty  Sensor  cs02/. 
xlabel/tiae  (seconds)/... 
ylabel/residual  value/' )> 
hardi ' residpltS.dat' ) 

// 

plot( ts, rav2, ' title/Anple 
xlabel/Tiaa  j seconds)/. . . 
ylabel/residual  value/' )i 
nard( ' residplt9.dat' ) 

plot(ta,rav3,'tltle/Fltch  Kate  Sensor  cs02/. 
xlabel/Tiee  (seconds)/... 
ylabel/residual  value/'); 
nard( ' residpltl0.dat' ) 

plot( ts, rsv4, ' title/Noraal 
xlabel/Tiae  (seconds)/... 
ylabel/residual  value/'); 
hard( ' residpltll.dat' ) 

plot(tB,rev5, 'title/»oll  Fate  Sensor  cs02/. 
xlabel/Tiae  i seconds )/.. . 
ylabel/residual  value/'); 
hard( ’ residpltl2.dat' ) 

plot(te,rsv6, 'title/Yaw  Rate  Sensor  cs02/. . 
xlabel/Tiae  i seconds)/. . . 
ylabel/residual  value/'); 
nerd( ' residpltl3.dat' ) 

plot(te,rsv7, 'title/Laterel  Acceleration 
xlabel/Tiae  (seconds)/... 
ylabel/residual  value/'); 
hard( ' residpltl4.dat' ) 

// 

//  right  atabilator 

rsvl>( rars( ! , 1 ) ,bdurs( s ,1) ,bdlrs( : ,1 ) 1 
rsv2>i rsrsi I , 2 ) , bdursi i,2),bdlrs(:,2)) 
rsv3-( rsrsi i , 3 ) ,bdurs( >,3),bdlrs( s,3)) 
rsv4>( rsrsi : , 4 ) , bdursi i,4),bdlrs(:,4)] 
rsvS'i rsrs( I , S) ,bdurs( i ,S) ,bdlrs( : ,5)  1 
rsv6>i rsrsi : ,S) , bdursi > ,6) ,bdlrs( : ,6) ] 
rsv7-i rsrsi > , 7 ) ,bdurs( i , 7 ) ,bdlrs( t ,7 ) ) 


Sensor  cs02/. 


plot(ta, rsvl, 'title/Veloclty  Sensor  cs03/... 
xlabel/tiae  iseconds)/. . . 
ylabel/residual  value/'); 
herd( ' residpltlS.dat' ) 
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plot ( ta, rsv2, ' titlc/An^l*  of  Attack  Sanaor  ca03/. . . 
alabal/Tlaa  ( aaconda)/. . . 
ylabal/raaldual  valua/’); 
hard( *  ttaldpltl6.dat' ) 


plot( ta, rav3, ' tltlo/Pitch  Kata  Sanaor  ca03/. . . 
alabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/* )i 
hard( ' raaldpltl7 .dat' ) 

// 

plot(ta,rav4, 'tltla/Noraal  Accalaratton  Sanaor  ca03/. . 
alabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/’); 
nard( *  raaldpltlS.dat' ) 

// 

plot( ta, ravS, ' tltla/Roll  Rata  Sanaor  ca03/. . . 
alabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*); 
nard( *  raaldpltl9.dat* ) 

// 

plot(ta,rav6, 'tltla/Yaw  Rata  Sanaor  ca03/. . . 
alabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/'); 
hard( *  raaldplt20.dat* ) 

// 

plot( ta, rav7, * tltla/Lataral  Accalaratlon  Sanaor  ca03/. 
alabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*); 
hard( *  raaldplt21 .dat* ) 

// 

//  laft  flaparon 

// 

ravl-(raie(:,l).bdul«(i.l).bdlie(:,l)) 
rav2-(ral(( <.2),bdult(;,2),bdllf( 1,2)) 
rav3«tral((i,3),bdul((s,3),bdllf(t,3)) 
rav4-(ral((i,4),bdulf( t,4),bdllf( 1,4)) 
ravS-(ralf(;.S),bdulf(t,S),bdllf(i.S)) 
rav6»(ral{(i,S) ,bdulf ( :,<),bdllf( 1,6)) 
rav7.(ralf(!,7),bdulf(i,7),bdll((:,7)) 


// 

plot( ta, ravl , * tltla/Valoclty  Sanaor  ca04/. . . 
alabal/tlaa  (aaconda)/... 
ylabal/raaldual  valua/'); 
hard( * raaldplt22 .dat* ) 

// 

plot( ta, rav2, * tltla/An9la  of  Attack  Sanaor  ca04/... 
alabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*); 
ha rd( 'roaldplt23.dat') 

// 

plot(ta,rav3, *tltla/Rltch  Rata  Sanaor  ca04/... 
xlabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*); 
hard( ' raaldplt24  .dat ' ) 

// 

plot ( ta, rav4 , ’ tl tla/Noraal  Accalaratlon  Sanaor  ca04/. . 
xlabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*); 
nard( ' raaldplt25.dat* ) 

// 

plot(ta,rav5, *tltla/Roll  Rata  Sanaor  ca04/... 
xlabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/'); 
nard( *  raaldplt26.dat' ) 

// 


D-8 


plot(  ta,  r«v6, ' titl«/Y«w  Rata  Sanaoc  ca04/. . . 
slabal/Tiaa  (taconda)/. . . 
ylabaX/raaldual  valua/')i 
hard( ' raaldplt27.dat' ) 

// 

pIot(ta, rav7, ' tltla/Lataral  Accalaratlon  Sanaoc  ca04/. 
xlabal/Tlaa  (aaconda)/. . . 
ylabal/raaldual  valua/')i 
hard( 'raaldplt28.dat* ) 

// 

//  right  (lapacon 
// 

ravl-(  rarf ( 1 , 1 ) .bducf ( i ,1 ) ,bdlrf( i , 1 ) ) 
rav2>i racf ( i , 2 ) .bducf ( i.2),bdlrfii.2)i 
rav3>i cacf ( t , 3) .bducf ( t . 3) .bdlcf ( t . 3 ) ) 
rav4-( racf ( i.4). bducf (:. 4). bdlrf( 1.4) ) 
ravS«i  racf  ( I . S) . bducf <  t . 5) .bdlcf ( t . S) j 
ravS>i racf ( i .6 ) .bducf! > .4) .bdlcf !  t .6 ) ) 
rav7>i racf ! i . 7 ) .bducf 1 1 .7) .bdlcf 1 1.7)] 


plot( ta. ravl . ' tltla/Valoclty  Sanaoc  caOS/. . . 
xlabal/tlaa  ! aaconda)/. . . 
ylabal/raaldual  valua/')i 
nacd( ' raaldplt29.dat' ) 

// 

plot(  ta,  rav2. * tltla/Angla  of  Attack  Sanaoc  caOS/. . . 
xlabal/Tlaa  ! aaconda)/. . . 
ylabal/raaldual  valua/')i 
hard( ' caaldplt30.dat' ) 

// 

plotCta,  rav3, 'tltla/x'ltch  Rata  Sanaoc  caOS/... 
xlabal/Tlaa  iaaconda)/. . . 
ylabal/raaldual  valua/')} 
nard< ' raaldplt31.dat' ) 

// 

plot(ta,rav4, 'tltla/Noraal  Accalaratlon  Sanaoc  caOS/.. 
xlabal/Tlaa  iaaconda)/... 
ylabal/raaldual  valua/' )i 
nard( ' caaldplt32 .dat' ) 

// 

plot( ta, ravS, ' tltla/Roll  Rata  Sanaoc  caOS/... 
xlabal/Tlaa  Iaaconda)/... 
ylabal/raaldual  valua/' )i 
nard( ’ caaldplt33.dat' ) 

// 

plot( ta, rav6, ' tltla/Yaw  Rata  Sanaoc  caOS/... 
xlabal/Tlaa  Iaaconda)/... 
ylabal/raaldual  valua/' )i 
nard( ' caaldplt34 .dat' ) 

// 

plot ( ta, rav7 , ' tl tla/Lataral  Accalaratlon  Sanaoc  caOS/. 
xlabal/Tlaa  Iaaconda)/... 
ylabal/raaldual  valua/'); 
nacd( ' raaldplt3S.dat' ' 

// 

//  ruddar 
// 

ravl-t rard( : , 1 ) .bdurd( : , 1 ) .bdlcd( : .1) ) 
rav2>[ rard( : , 2 ) ,bducd( : ,2) .bdlcdl t , 2 ) ) 
cav3«j  rard( : , 3 ) ,bdurd( : , 3) ,bdlcd( : , 3 ) ) 
rav4>i card] i , 4 ) ,bdurd( : ,4) .bdlcdl i ,4 ) ] 
ravS'i rardi t , S) .bdurdi t ,S) .bdlcdl i , S) ) 
rav6-i  card! t ,S ) ,bdurd( :  ,6) .bdlcdl i ,S ) ] 
rav7-i rardi ( , 7 ) ,bdurd( ; .7) .bdlcdl i , 7 ) J 
// 

plot( ta, ravl ,' tltla/Valoclty  Sanaoc  caOS/... 


D-9 


xlab*l/tlat  (aaconda)/. . • 
ylabtl/raaldual  valua/')i 
nard( ' raaldplt36 .dat' ) 

plot(ta,rav2,'tltl#/Angla  of  Attack  Sanaor  ca06/. . . 
xlabal/Tiaa  (aaconda )/. . . 
ylabal/raaldual  valua/')/ 
hard( *  raaldplt37.dat' ) 

plot(ta,rav3, 'tltla/Pitch  Rata  Sanaor  caOS/. . . 
xlabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*)) 
hard( ' raaldplt36.dat' ) 

plot(ta,rav4,'titla/Noraal  Accalaratlon  Sanaor  ca06/. 
xlabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*)) 
hard( *  raaldplt39.dat* ) 

plot(ta, ravS, 'tltla/Roll  Rata  Sanaor  caOS/. . . 
xlabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*)) 
ha rd( *  raaldplt40.dat* ) 

plot(ta,rav6,*tltla/Yaw  Rata  Sanaor  ca06/. . . 
xlabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/')) 
hard(' raaldplt41.dat*) 

plot( ta, rav7, * tltla/Lataral  Accalaratlon  Sanaor  ca06/ 
xlabal/Tlaa  (aaconda)/... 
ylabal/raaldual  valua/*)) 
hard( *  raaldplt42.dat' ) 

// 
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//  This  Macro  plots  rssults  froa  NMAESIN  that  art  thesis 
//  quality  to  bs  used  for  prlntlnq  on  ths  I 
// 

prl»prb( t , 4 ;9 ) } 
pr2>prb( : ,10 i 16 ) > 

// 

plott ti .prl ,* strip  ... 

tltls/Prohablllty ,  Lsf t_Stabllator_rallurs/ 
yaln/0/  ya«s/l/  ...  ~ 

xlabsl/Tlas  (seconds)/  ... 
ylabsl/rPiAl|A2|A3|A4|A5/' ) 
hard('pllal  hfsl.dat*) 

// 

plot(tl,pr2, 'strip  ... 

tltls/Probablllty,  Left  Stabllator_Pallurs/ 
yaln/0/  yaax/l/  ...  “  “ 

xlabsl/Tlas  (ssconds)/  ... 
ylabsl/Sl|S2|S3|S4|SS|S6|S7/' ) 
hard( ’pl2al  hfsl.dat' ) 

// 

//sql>( st( ! , 1 :6) ,qs(  t , 1 :2) ) } 
sgl>(  st(  t ,  1 : 4 ) ,gs( : , 1 ) ) } 

S92-(st(  :.Si6),qs(:,2)i; 

// 

rtod-57.29576| 
sqU  1 , 1 )-rtod*sql( ; , 1)  > 

S9l(  i ,  3 : 4 )-rtod*S9l< : , 3:4 ) } 

S92( I ,1 :4)*rtod*S92( t ,1:4); 

// 

plot(tl,S9l, 'atrip  ... 

tltls/Statss,  Left  Stabllator_Pallura/  ... 
xlabsl/Tlas  (ssconHs)/  ...  ~ 

ylabsl/thsta|u|alpha|q|Anc9/' ) 
nard('pl3al  hfsl.dat') 

// 

plot(tl,s92, 'strip  ... 

tltls/Statss,  Left  Stabilator_Pallurs/  ... 
xlabsl/Tlas  (ssconSs)/  ...  ~ 

ylabsl/phl jbsts Ipl r lAycg/' ) 
hard('pl4si  hfsl.dat') 


used  for  printing  on  ths  LN03  lassr  prlntsr. 


Lsft  Stabllator  Pallurs/ 
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//  This  Macro  plots  rssults  frost  HHABSIN  that  ara  thasis 
//  quality  to  ba  usad  for  prlntlnq  on  the  LN03  laser  printer. 
// 

prl>prb( t , 4 :9 ) } 
pr2«prb( t, 10:16); 

// 

plot( tl ,prl strip  ... 

tltle/Probablllty,  No_Pallure  scenario,  /  ... 
y«ln/0/  ynax/1/  ...  ~ 

xlabel/Tlae  (seconds)/  ... 
ylabel/PP|Al|A2|A3|A4|AS/') 
hsrd('pllff  hfsl.dat') 

// 

plot( tl ,pr2 strip  ... 

tltle/Probablllty,  No  Pallure  scenario/  ... 
yaln/0/  y«ax/l/  ...  ~ 

xlabel/Tlae  (seconds)/  ... 
ylabel/Sl|S2|83|S4|S5|S6|S7/' ) 
hard('pl2ff  hfsl.dat') 

// 

//sql-t  st( t , 1 tS) ,9S(  1 ,1:2) ) ; 
sql-l st( : , 1 : 4 ) ,9S( :  ,1 ) ) ; 

S92-( st( t,St6),9S(t,2)); 

// 

rtod-57.2957S; 

S9l(t,l)>rtod*S9l(:,l); 

S9I ( : , 3 : 4 )>rtod*S9l( : , 3 :4 ) ; 

S92( 1 , 1 : 4 )>rtod*S92( : ,1:4) ; 

// 

plot( tl , S9I ,' Strip  ... 
tltle/States,  No  Pallure  scenario/  ... 
xlabel/Tlae  (seconds)/  ... 
ylabel/thatajulalpha (q(Anc9/' ) 
hard('pl3ff  hfsl.dat') 

// 

plot(tl,S92, 'strip  ... 
tltle/States,  No  Failure  scenario/  ... 
xlabel/Tlae  (seconds)/  ... 
ylabel/phl (beta | p| r | Aycq/' ) 
nard('pl4ff  hfsl.dat') 

// 
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// 

GQGT  -  e  •  Q  •  O'l 

rp2  •  ri 

PP2(n4’l,n4l)  ••  0.| 

PHI  -  ■pllt(dlac(PP2.n,d«lt) ,n) ) 

PGQGPT  -  PHI  •  GQGT  *  PHl'i 

Qd  -  (PGQGPT  *  GQGT)  •  O.S  •  dalt) 

dear  GQGT  PGQGPT  PP2| 

// 

qtaap  -  Gd*Qd*Gd'f 

t««p77  -  (PHI'«M'/P*H/PHI*qt«*p,  -H'/**H/PHI>  -PHI\qt**p, inv( PHI ' ) ' J » 

( vtcHp.dtaBp]  >  al9(ta«p77)| 

dtaap  >  diagidtaapii 

ldx77  -  aort(aba(dtaap) ) I 

chl77  •  vtaap( 1 :n, idx77( 1 tn) ) I 

laada7  >  vtaap( (n«l ) i ( 2*n) , idx77( 1  in) ) ; 

ataap  -  laadaVchi77; 

Paaa  >  ataap' ; 

Kaa  -  ataap*RV(H*ateap*H'  *■  K)i 
Ppaa  -  PRI\(Paaa-Gd*Qd*Gd' )/PHI' } 

Paaa  >  raaKPaaa)! 

Kaa  raal(Raa)i 

Ppaa  >  caal(Ppaa)i 

claar  dtaap  idx77  chl77  laada7  ataap  taap77  vtaap  qtaap; 

qkf'kaa; 

phlx-phi I 

od*. S* ( phl*b4b) *dalti 
cqd-(chol(qd(l:8,l:8)))'i 
ak«h*paaa*h'>r; 
aklnv«inv( ak ) i 
datakodat(ak) t 
raturni 
// 

4' 
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QWICK 


icrevAL' ) 


ditplayC ' 
diaplayl*  ') 
diaplay( * 
dltplay( ' 
dltplay( ' 
dltplay(  •  '  ) 
dlaplay( ' 
diaplayt'  ') 


A  Ralaar  rlltac  Ptrforaanca  Evaluation  Tool') 
by' ) 

Patar  S.  Haybeck') 

Vataion  VAXl.2  ALL  RIGHTS  RESERVED') 


OQGT  -  C  •  Q  •  G' ; 

Pr2  -  P| 

rP2(n«l.n«l)  -  O.j 

PHI  >  aplit(disc(PP2,.i,dalt),n); 

PGQGPT  -  PHI  *  GOGT  •  PHI') 

Qd  -  (PGQGPT  ♦  GOGT)  *  0.5  *  dalt) 
claar  OQGT  PGQGPT  PP2/ 


qtaap  ■  Gd*Qd*Gd' ) 

taapT?  -  (PHI '♦H'/R*H/PHI*qta«p,  -H'/R»H/PHI;  -PHl\qta«p, 

( vtaap.dtaap)  •  aigCtaapT?)) 

dtaap  -  diaq(dtaap)) 

ldxl7  -  sort(abs(dta*p) ) ) 

chl77  «  vta*p( 1 :n, id*77( 1 :n) ) ) 

laMda7  ■  vtaaip(  ( nal )  J  ( 2*n) ,  ldx77(  1 : n) ) ) 

ataap  *  Iaada7/chl77 ; 

Paaa  -  ataap' t 

Kaa  •  ataap*H'/(H»ataap‘H'  +  R)) 
ppaa  -  PHl\(Paaa-Gd*Qd»Gd' )/PHi' ) 

Paaa  •  raaKPaaa) ; 

Raa  •  raal(Raa); 

Ppaa  -  raal(Ppaa) ) 

claar  dtaap  idx77  chi77  la»da7  ataap  taap77  vtaap  qteap; 

//  fora  Augaentad  Hatricaa  for  Parforaanca  Evaluation 
// . - . 

Pa  ■  (ft,  -Xt)  0*onaa(n,nt) ,  f-x); 

Ca  ■  (Gt;  0*onea( n, at ) ) ) 

GaQaGaT  -  Ga  *  Qt  •  Ga') 
na  «  nt  ♦  n; 

ffa2  -  fa; 

ffa2(naal .na^l )  ■  O.j 
ffa2D  «  diac(Pfa2,na,dalt)) 
fHia  •  aplit(ffa2o.na); 

PGQGPTa  -  PHia  •  GaQaGaT  •  PHla'j 

Qda  -  (PGQGPTa  ♦  GaQaGaT)  *  0.5  •  dalt; 

claar  ffa2  ffa20  PG(2GPTa  GaQaGaT  fa  Ca  na; 

Da  ■  laya(nt),  -Dt;  0*onaa(n,nt) ,  aya(n)-D); 

Ca  -  (-Ct,  C) ;  , 

Pao  -  (Pto,  0*onaa(nt,n) ;  0*onaa(n,nt) ,  0»onaa(n)); 

Aaaa  -  (aya(nt),  O‘onaa(nt.n) ;  Raa*Ht,  aya ( n ) -Kaa*H J  ; 
xaaa  >  (  0*onaa( nt,a) ;  Kaa); 

Paa  >  Pao; 

Paa  -  Ca  *  Paa  •  Ca' ; 

Pa  -  Paaa; 

Paaf  -  C  *  Pa  *  C' ; 


inv(PHI' ) ' 


); 


K  -  Kaa; 
fp  •  Ppaa; 

Aa  -  Aaaa; 

Ra  ••  Xaaa; 

Pap  -  Aa  •  Paa  •  Aa'  ♦  Ra  •  Rt  •  Xa'; 
Pap  -  Ca  •  Pap  •  Ca' ; 

Papf  -  C  •  Pp  •  C'; 

Pape  -  Da  •  Pap  •  Da'; 

Pepc  -  Ca  •  Pape  •  Ca'; 

Papef  -  Papf; 
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#■  >  dia9< P**) > 

ap  >  dia9(  Pap) > 

ape  -  dia9(  Pape )  i 

ETRUC  -  (aa'j  ap';  ape'); 

'ml  •  dla9( Panf ) ; 
apt  >  dla9( Papf ) ; 
apef  •  dla9(Papef); 

EPILT  -  ta»f';  apf';  apef'); 

diaplay( ' Initialization  at  tiaa  to  is  eoaplata') 
display!'  ') 

//  Main  Loop:  Itatata  for  i  -  1  to  i  -  ITOTAL 

// - 

ita9-l ; 
xitar-0; 

for  Inust  •  1:  ITOTAL;... 

Pa  •  Pass ; .  . . 

Paa  -  PHia  *  Pape  *  PHia'  Qdai... 

Paa  -  Ca  •  Paa  *  Ca' ; . . . 

Paaf  -  C  •  Pa  •  C';... 

R  •  Rss ; .  . . 

Pp  -  Ppss; . .  . 

Aa  •  Aass; . . . 

Ra  -  Rass; . . . 

Pap  -  Aa  *  Paa  *  Aa'  ♦  Ra  *  Rt  *  Ra';... 

Pap  •  Ca  *  Pap  *  Ca';... 

Papf  ■  C  •  Pp  •  C' ; . . . 

Pape  -  Da  •  Pap  •  Da';.., 

Pape  •  Ca  •  Pape  •  Ca'i... 

Papef  ■  Papf ; . . . 
aa  ■  dia9(Paa) ; . . . 
ap  •  dia9( Pap) i • • • 
ape  «  dia9(Pape) ; . . . 

ETRUE  -  (ETRUE;  aa' ;  ap' ;  ape');... 
aaf  -  dla9( Paaf ) ; . . . 
tpf  >  dia9( Papf ) ; . . . 
apef  >  dia9( Papef );.. . 

EPILT  -  (EPILT;  aaf';  apf';  apef');... 
xitar^xitar-f  1 ; . . . 
xta>xitar*dalt; . . . 
if  xta-itao; . . . 

SECONDS-ita9,  . . . 
ita9-ita9>l ; . . . 
and; ... 
and; 

elaar  xitar  xta  ita9  SECONDS; 

// 

//  End  of  Main  Loop  to  Conduet  Parforaanea  Analysis 

. . 

// 

//  Establish  Data  Piles  for  Plottin9 

// - 

// 

RTETRUE  •  sqrt( ETRUE); 

RTEPILT  -  Sqrt(EPILT); 
tlaasT  •  (0  0  0 ) ; 
for  i  -  1: ITOTAL;... 

tiaesT  •  (tiaasT,  i,  i,  1);... 

and 

tiaas  •  dalt  *  tiaasT'; 

dl splay( ' Data  is  now  raady  for  plottinq.') 

// 

. . . 

// 

//  Ganarata  Plots  Itarativaly,  until  user  quits 
// 

HOREPLTS  -  1; 
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while  nOREPLTS  >-  1;  .  .  . 

Inquire  j  'Enter  Inteqer  Index  of  variable  of  interest: 

Inquire  atrtt  'Enter  plot  start  tiaa: 

Inquire  stpt  'Enter  plot  stop  tiae: 
stt-( (strtt/delt)*3)*l; . . . 
spt-( ( stpt/delt )♦! ) *3 j . . . 
xpl-tiaes(stt:spt);... 

ypl-lBTETRUEi  Stt.’Spt,  j)  RTEPILTi  stt :  spt,  i  )  1  >  .  .  . 

plot ( xpl , ypl , ' syabol  aark  2  4  line  xlabel/SECONDS/  ylabel/ERROR/. . . 
tltle/LEGEND:  TRUE(O),  PI LTER-COHPUTED{ ♦ )/  gr id ' > j . , . 

fausej . . . 

nquire  MOREPLTS  'Do  you  want  aore  plota  Enter  1  for  YES  or  0  for  NO: 
end; 

clear  j  atrtt  atpt  lin77  grd7  stt  apt; 
erase; 

// 

//  End  of  Loop  to  Generate  Plots 

// - 

// 

clear  NEWVARS  OKV  Pap  Pep  Pepf  Pape  Pepc  Pepcf  ea  ep  epc  Ca  Kass  Qda; 
clear  eaf  epf  epef  Pea  Peaf  K  Pp  Aa  Ka  MOREPLTS  Pao  Da  Paa  PUIa  Pa  xpl  ypl; 


D-16 


//  This  Macro  plota  results  fro*  MNACSIN  that  are  thesis 
//  quality  to  be  used  for  printing  on  the  LN03  laser  printer. 
// 

prl-prb( t  ,it9)  I 
pr2-prb( : , 10 ; 16  ) ; 

// 

plot(tl,prl, 'strip  ... 

tltle/Probablllty,  AOA_Sensor  Failure/  ... 
y*ln/0/  y*ax/l/  ...  “  “ 

xlabel/Tl*e  (seconds)/  ... 
ylabel/rP|Al |A2 |A3 |A4 |AS/' ) 
hard( 'plls2  hfsl.dat' ) 

// 

plot( tl , pr2 strip  ... 

tltle/Probablllty,  AOA_Sensor_Pal lure/  ... 
y*ln/0/  y*ax/l/  ...  ~ 

xlabel/Tl*e  (seconds)/  ... 
ylabel/Sl|S2|S3|S4|SS|S6iS7/') 
hard('pl2s2  hfsl.dat') 

// 

//sgl-t  st(:,l!e),gs(:,l:2)); 

S9l>[ at( : , 1 : 4 ) ,gs( : , 1 ) )  > 
sg2>[ st( : ,5:6) ,gs( : ,2) ] ; 

// 

ttod-57.29578j 

sgl( : ,1 )-rtod*sgl ( : , 1 ) t 

sgl(:,3:4)>rtod*sgl(:,3:4)) 

sg2( t,l;4)«rtod*sg2( :,1:4)| 

// 

plot( tl , sgl ,' strip  ... 
title/states,  AOA  Sensor_Pallure/  ... 
xlabel/Tl*e  (seconds)/  .7. 
ylabel/theta (u (alpha (q(Ancg/' ) 
hard('pl3s2  hfsl.dat') 

// 

plot( tl , sg2 ,' strip  ... 
tltle/States,  AOA  Sensor_rsllure/  ... 
xlabel/Tl*e  (seconds)/  .7. 
ylabel/phl | beta | p| r 1 Aycg/' ) 
hard( 'pl4s2  hfsl.dat') 

// 
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SBTUPBl.HXX  HATRIXX  EXECUTABLE  MACRO 


Author 
Date  created 
Date  revised 


Capt  Gregory 
20  August  19 


L.  Stratton 
91 


26  September  1991 


This  macro  creates  and  saves  to  flics  all  the  required 
matrices  for  a  single  bank,  as  used  In  HHAESIN.  This 
Is  normally  called  from  the  macro  PILECREATE.NXX,  however. 
It  can  be  used  by  Itself  os  long  as  the  below  listed 
variables  currently  exist  in  memory  In  matrixx. 

Below  are  listed  the  required  Input  matrices  and  variables: 


//  bbcon, 
//  9. 
//  gd, 
//  q. 

//  fcon, 
//  bcon, 
//  hcon, 
//  delt, 
//  n, 
//  bank, 
//  cil4, 
//  cs8, 
//  r*14. 


The  6x8  plant  matrix 
The  8x6  plant  B  matrix 

The  white  Gaussian  noise  multiplier  matrix  (as  In  G*w(t)) 

An  Identity  matrix  of  size  14x14 

The  white  Gaussian  noise  covariance  matrix 

The  14x14  plant  matrix  augmented  with  1st  order  actuators 

The  14x6  B  matrix  of  the  augmented  system 

The  7x14  R  matrix  of  the  measurement  equation 

The  sample  time  (here  1/64  Rs) 

number  of  states  of  the  augmented  system  (here  14) 
number  of  bank  of  which  filters  are  being  created 
column  vector  of  14  zeros 
column  vector  of  6  zeros 
row  vector  of  14  zeros 


Note:  any  of  the  variables  above  with  'con'  In  its  name  may 

contain  tows  or  columns  of  zeros,  simulating  an  already 
detected  first  failure. 

This  macro  creates  14  files  of  the  form:  PxxBl.DAT 
where  xx  Is  the  filter  number  (04  thru  17) 

This  macro  calls  the  macro  "mtx.mxx*  which  generates  the  required 
matrices  for  each  filter. 


//  fully  functional  filter,  104 
// 

fbk-.04«bank/10000) 

f-faug; 

b-baug; 

bb-borig; 

h-hor Ig ; 

exec( ' mtx . mxx ' ) 

fsave  'r04Bl.dat'  ... 


fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  aklnv  detak 

// 

//  also  save  the  fully  functional  case  to  the  first 
//  three  'filters'  (truth  models)  so  as  to  have  at 
//  least  something  to  start  with 
// 

//  usually  the  first  truth  model  (f01bl.dat)  will 
//  be  the  fully  functional  case,  and  f02bl.dat  and 
//  f03bl.dat  will  hold  the  first  single  and  double 
//  failure  truth  models  respectively 
// 

fsave  'f03bl.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  aklnv  detak 
fsave  'f02bl.dat'  ... 
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fbk  aa  bb  phlx  bd  cqd  h  ^kf  r  ak  aklnv  datak 
fsava  'fOlbl.dat*  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 

//  actuator  1  fallura  filter,  105 
// 

fbk-fbk«.01i 

fofcon} 

b«bcon) 

h«hcon; 

//IK  ! ,9)-cxl4; 

b(  :  ,l)-cxl4; 

bb'bbcon; 

bb( : , 1 )>cx8 1 

exaci ‘atx.axx' ) 

fiava  'rOSBl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 


//  actuator  2  failure  filter,  106 
// 

fbk-fbk>.01; 
f-fcon; 
b-bcon; 
h>hcon ; 

//f ( I ,10)-cxl4| 

b( j , 2 )-cxl4; 

bb-bbconj 

bb( ; ,2)>cx6; 

exaci '«tx .axx' ) 

fsava  'P06Bi.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 


//  actuator  3  fallura  filter,  #07 

// 

fbk-fbk*.01; 

fafconj 

b»bcon; 

h-hcon; 

//f(  :,lU-cxl4» 

b(  :  ,3)>csl4; 

bbabbcon; 

bb< : , 3 )-cs8; 

exaci 'atx .axx' ) 

fsava  'P07Bl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 


//  actuator  4  failure  filter,  108 
// 

fbk-fbk^.Ol; 

f-fcon; 

b-bcon; 

h-hcon; 

//f ( ! , 12 )-cxl4 ; 

b(  ;  ,  4  )-cxl4 ; 

bb-bbcon; 

bb( ! , 4 )-cx8 ; 

exec( 'atx.axx' ) 

fsave  'r08Bl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 


// 

//  actuator  5 
// 

fbk-fbkt.Ol; 

f-fcon; 

b-bcon; 

h-hcon; 


failure 


filter. 


#09 
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//f ( ! ,13)-cil4} 

b(  :  ,5)-cil4| 

bb-bbconi 

bb( : ,S)-ct8j 

•x«c( ’atx.axx' ) 

ftav*  'P09Bl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  detak 

//  tansor  1  fallura  filtar,  110 
// 

fbk-fbk^'.Oii 

f-fconi 

b-bconi 

h>hcon; 

h(l, : )-ril4j 

bb-bbcon j 

axac( 'atx.axx' ) 

ftava  'flOBl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  c  ak  akinv  detak 


//  aanaor  2  failure  filter,  ill 
// 

fbk-fbk4.01> 

f-fcon; 

b-bconj 

h«hcon; 

h(2, : )-rxl4> 

bb'bbcon; 

exec( 'atx .axx'  ) 

ftava  'PllBl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 


//  tentot  3  failure  filter,  112 
// 

fbk-fbk*.01> 

fafconi 

b>bcon; 

h«hcon; 

h( 3, ; )-ril4f 

bb-bbcon; 

exec( 'atx .axx' ) 

ftava  'P12Bl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 


//  aantor  4  failure  filter,  113 
// 

fbk-fbk«.01; 

f >f con ; 

b-bcon; 

h-hcon> 

h<4, : )-r*14; 

bb-bbcon; 

exec( 'atx.axx'  ) 

ftava  'ri3Bl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 


//  tentot  5  failure  filter,  114 

// 

fbk-fbk^.Ol; 

f-fcon; 

b-bcon ; 

h-hcon; 

h«5, !)-rtl4; 

bb-bbcon; 

exec( 'atx.axx'  ) 

ftava  'P14Bl.dat'  ... 
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fbk  a«  bb  phix  bd  cqd  h  gkf  c  «k  akinv  datak 

// 

//  ••ntor  6  fallura  filtar,  IIS 
// 

fbk-fbk«.01> 

f-fcon; 

b'bcon; 

h>hconi 

h(6, I )-ril4| 

bb-bbconi 

axac( ’■tx.Bxx'  ) 

ftava  'rlSBl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 
// 

//  aanaor  1  failuca  (lltac,  116 
// 

fbk-fbk«.01; 

fafconi 

b-bcon; 

h«hconi 

h(7, i )-rxl4; 

bb>bbcon  j 

axac( ' atx . *xx '  ) 

ftava  'Pl6Bl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 

// 

// 

//  actuator  6  failura  filtar,  117 
// 

//  this  hat  baan  raaovad,  but  can  ba  uncouentad  out 
//  originally,  tha  failad  act  6  filtar  wat  110, 

//  but  it  now  appcndad  on  to  tha  and  (at  filtar  417) 
//  if  utad. 

// 

//fbk-fbk>.01; 

//f«fcon; 

//b«bcon; 

//h-hcon I 

////f ( : ,14)-c*14; 

//b( : , 6 )«ccl4  > 

//bb-bbcon ; 

//bb( : ,6)>cx0; 

//axac( 'atx .axx' ) 

//ftava  'riOBl.dat'  ... 

//fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 
// 


// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 


SBTUPB2.HXX  KATRIXX  CXCCUTABLE  MACRO 

Author:  Capt  Grtgory  L.  Stratton 
Data  craatad:  20  Auguat  1991 
Data  ravltad:  26  Saptanbar  1991 

This  aacro  craatat  and  aavat  to  fllaa  all  tha  raqulrad 
■atricaa  for  a  alngla  bank,  at  utad  in  NHAESIN.  Thia 
ia  noraally  callad  fro*  tha  aacro  PILECREATB.MXX,  howavar. 
It  can  ba  uaad  by  Itaalf  aa  long  aa  tha  below  llatad 
variablaa  currently  axlat  in  aaaory  In  aatrixx. 

Below  are  llatad  tha  raqulrad  Input  aatrlcaa  and  variablaa: 


aa, 

bbcon, 

9. 

id. 

q. 

fcon, 
bcon, 
hcon, 
dalt, 
n, 
bank , 
czl4, 
cz8 , 
rzl4 , 

Note: 


( aa  In  G*w( t ) ) 


Tha  8x8  plant  aatrlx 
Tha  8x6  plant  B  Matrix 

The  white  Gauaalan  nolaa  Multiplier  Matrix 
An  Identity  Matrix  of  alza  14x14 
Tha  white  Gauaalan  nolaa  covariance  Matrix 
Tha  14x14  plant  Matrix  augaentad  with  lat  order  actuatora 
Tha  14x6  B  Matrix  of  tha  augaentad  ayataa 
Tha  7x14  H  Matrix  of  tha  Maaauraaant  aquation 
The  aaapla  tlaa  (hare  1/64  Bz) 

nuabar  of  atataa  of  the  augaanted  ayataa  (hara  14) 
nuabar  of  bank  of  which  flltara  are  being  created 
coluan  vector  of  14  zaroa 
coluan  vector  of  8  zaroa 
row  vector  of  14  zaroa 

any  of  tha  variablaa  above  with  'con'  In  Ita  name  aay 
contain  rowa  or  coluana  of  zaroa,  alaulatlng  an  already 
detected  firat  failure. 


.DAT 


Thla  Macro  craataa  14  fllaa  of  tha  fora:  PxxB2. 
where  xx  la  tha  filter  nuMbar  (04  thru  17) 

Thla  Macro  calla  tha  Macro  *Mtx.Mxx*  which  ganarataa  tha  required 
Matricea  for  each  filter. 


START 


MACRO 


fully  functional  filter,  104 


fbk-.04*bank/10000; 
f-faugi 
b-baug; 
bb-borig; 
h'horlg; 
axac( ' Mtx . Mxx ' ) 
faava  'r04B2.dat' 
fbk  aa  bb  phlx  bd 
// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

faava  'f03B2.dat' 
fbk  aa  bb  phlx  bd 
faava  'f02B2.dat' 


cqd  h  gkf  r  ak  aklnv  datak 

alao  aava  tha  fully  functional  case  to  tha  firat 
three  'flltara'  (truth  Modala)  ao  aa  to  have  at 
laaat  aoMething  to  atart  with 

uaually  tha  firat  truth  Modal  (f01B2.dat)  will 
ba  tha  fully  functional  caaa,  and  f02B2.dat  and 
f03B2.dat  will  hold  tha  firat  alngla  and  double 
failure  truth  Modala  raapactlvaly 


cqd  h  gkf  r  ak  aklnv  datak 
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fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 
faava  '{01B2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 

//  actuator  1  failura  flltar,  105 
// 

fbk-fbk+.Ol; 
f-fconi 
b-bcon j 
h-hconj 
//f( 

b( ! ,l)«cil4; 
bb-bbconi 
bb( I , 1 )-cx8) 
axac( 'Mtx .axx'  ) 
faava  'rOSB2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 


cqd  h  gkf  r  ak  akinv  datak 
failura  flltar,  107 


//  actuator  2  failura  filtar,  106 
// 

fbk-fbk«.01; 

f'fconj 

babconi 

h-hcon; 

//f( !,10)-cal4j 
b( ! ,2)-cal4j 
bbabbcon; 
bb( : ,2)*cx8; 
axac( ’atx.axx'  ) 
faava  'r06B2.dat' 
fbk  aa  bb  phix  bd 
// 

//  actuator  3 
// 

fbkafbk^.Ol; 
fafcon; 
babcon  j 
hahcon; 

//f( : ,ll)-cxl4j 
b( : , 3)acal4; 
bbabbcon; 
bb( : ,3)aca8; 
axac( 'atx.axx'  ) 
faava  ’r07B2.dat' 
fbk  aa  bb  phix  bd 
// 

//  actuator  4 
// 

fbkafbk+.01> 

fafcon; 
babcon ; 
hahcon ; 

//f( ! ,12)acal4; 
b( ! ,4)acal4; 
bbabbcon; 
bb( : , 4 )acz8; 
axac( 'atx .axx'  ) 
faava  'r08B2.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  5 
// 

fbkafbk^.Ol; 
fafcon; 
babcon; 
hahcon; 


cqd  h  gkf  t  ak  akinv  datak 
failura  flltar,  108 


cqd  h  gkf  r  ak  akinv  datak 
failura  flltar,  109 
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//(( : ,13)«ctl4| 

b( t ,5)-czl4j 

bb'bbconi 

bb( I ,S)-cc8i 

•xtc( '■tx.axx' ) 

f>«v«  ’r09B2.dat'  ... 

fbk  ••  bb  phix  bd  cqd  h  ^kf  r  ak  akinv  datak 
// 

//  atnaor  1  failura  (iltar,  110 
// 

fbk-fbk«.01> 

fmtconi 

b'bcon; 

h>hcon} 

h(l,  ;  )-rzl4; 

bb>bbcon; 

axac( 'atx .axx' ) 

(aava  'rlOB2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 
// 

//  sanaor  2  failura  filtar.  111 
// 

fbk-fbk^.Ol) 

f«fcon I 

b«bcon; 

h-hcon ; 

h( 2 , t  )>rzl4 ] 

bbabbcon; 

axac( 'atx .axx'  ) 

faava  ’PllB2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  tanaor  3  failura  filtar,  112 

// 

fbk-fbk>.01> 

f«fcon; 

b»bcon> 

h-hconi 

h( 3, 1  )-rzl4; 

bb-bbcon; 

axac( 'atx.axx* ) 

faava  'P12B2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  sanaor  4  failura  filtar,  113 
// 

fbk>fbk4.01; 

fafconj 

b-bconi 

h-hcon; 

h( 4  ,  :  )-rzl4  > 

bb-bbcon; 

axac( 'atx.axx' ) 

faava  'P13B2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  sanaor  5  failura  filtar,  114 

// 

fbk-fbk^.Oli 

f-fcon; 

b-bcon; 

h'hcon; 

h( 5, !  )>rsl4 ; 

bb-bbcon I 

axac( 'atx.axx' ) 

faava  'P14B2.dat'  ... 
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fbk  aa  bb  phlx  bd  cqd  h  9kf  r  ak  akinv  datak 

//  aanaor  6  (allura  flltac,  115 
// 

fbk-ebk4>.01) 

(«(coni 
b-bcon; 
h'hcon; 
h(6, : )-r*14i 
bb>bbconi 
axac(  '•tx.aixx' ) 
fsava  'rl5B2.dat' 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 

//  aanaor  7  failura  filtar<  #16 
// 

fbk-fbk«.01; 
f-fcon; 
b>bcon) 
h-hcon; 
h(  7,  :  )Ttl4  ; 
bb-bbconi 
axac( ’atx .■XX' ) 
faava  'rl6B2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  actuator  6  failura  filtar,  #17 

//  thia  haa  baan  raaovad,  but  can  ba  uncoaaentad  out 
//  oriqinally,  tha  failed  act  6  filter  waa  #10, 

//  but  ia  now  appended  on  to  tha  and  (aa  filter  #17) 
//  if  uaad. 

// 

//fbk-fbk>.01> 

//f-fconj 
//b"bcon; 

//h-hcon j 
////f ( s , 14)-czl4» 

//b( I ,6)-cal4; 

//bb-bbcon; 

//bb( I ,6)-ca8; 

//axac( 'atx.mxx'  ) 

//faava  'Pl0B2.dat'  ... 

//fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

return 

// 

Va 
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SETUPB3.MXX  HATRIXX  EXECUTABLE  HACRO 


// 

// 

// 

//  Author:  Capt  Gre9ory  L.  Stratton 

//  Data  creatad:  20  August  1991 

//  Data  raviaad:  26  Sapteabar  1991 

// 

//  This  aacro  craatas  and  savec  to  filat  all  tha  ragulrad 
//  aatrlcaa  for  a  ilngla  bank,  as  usad  in  HHAESin.  This 
//  is  noraally  callad  froa  tha  aacro  PILBCREATE.NXX,  howavar, 

//  it  can  ba  usad  by  itsalf  as  long  as  tha  below  listed 
//  variables  currently  exist  in  aeaory  in  aatrixx. 

// 

//  Below  are  listed  tha  required  input  aatrices  and  variables: 

// 

//  aa,  The  6x6  plant  aatrix 

//  bbcon,  Tha  6x6  plant  B  aatrix 

//  g,  Tha  white  Gaussian  noise  aultipllar  aatrix  (as  in  G*w(t)) 

//  gd.  An  identity  aatrix  of  site  14x14 

//  q,  The  white  Gaussian  noise  covariance  aatrix 

//  fcon,  The  14x14  plant  aatrix  augaentad  with  1st  order  actuators 

//  boon,  Tha  14x6  B  aatrix  of  tha  augaentad  systaa 

//  hcon,  Tha  7x14  H  aatrix  of  the  aeasureaent  equation 

//  dalt.  The  saapla  tiaa  (here  1/64  Rt) 

//  n,  nuabar  of  states  of  the  auoaentad  systaa  (here  14) 

//  bank,  nuaber  of  bank  of  which  filters  are  being  created 

//  csl4,  coluan  vector  of  14  taros 

//  ct6,  coluan  vector  of  6  teros 

//  rtl4,  row  vector  of  14  zeros 

// 

//  Note:  any  of  the  variables  above  with  'con'  in  its  naae  aay 
//  contain  rows  or  coluans  of  zeros,  siaulating  an  already 

//  detected  first  failure. 

// 

//  This  aacro  creates  14  files  of  the  fora:  PxxB3.DAT 
//  where  xx  it  tha  filter  nuaber  (04  thru  17) 

//  This  aacro  calls  tha  aacro  'atx.axx*  which  generates  tha  required 
//  aatrices  for  each  filter. 

// 

// 

//  START  RACRO 

// 

// 

//  fully  functional  filter,  104 
// 

fbk-.04«bank/10000| 

f-faug; 

b-baug i 

bboborig; 

h'horig; 

axac( 'atx.axx'  ) 

fsava  'P04B3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  detak 

// 

//  also  save  tha  fully  functional  case  to  tha  first 
//  three  'filters'  (truth  aodels)  so  as  to  have  at 
//  least  soaething  to  start  with 
// 

//  usually  the  first  truth  aodel  (f01B3.dat)  will 
//  be  tha  fully  functional  case,  and  f02B3.dat  and 
//  f03B3.dat  will  hold  tha  first  single  and  double 
//  failure  truth  aodels  respectively 
// 

fsava  'f03B3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  detak 
fsava  'f02B3.dat'  ... 


fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 
fsavt  'fOlB3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  c  ak  akinv  datak 

// 

//  actuator  1  fallura  flltar,  lOS 
// 

fbk-fbk>.01t 

f>fconi 

b-bcon; 

h»hcon; 

//f(:,9)-c«H; 

b(  J.l)-cil4; 

bb-bbconi 

bb(  i ,  1  )<«ca6} 

axaci ‘atx.Bxx'  ) 

ftava  'rOSB3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

//  actuator  2  fallura  flltar,  106 
// 

fbk-fbk>.01; 

f>fcon; 

b'bconi 

h-hconi 

//f( : .10)-czl4; 

b( !  ,2)-c*14» 

bb-bbcon; 

bb( : ,2)-ciS; 

axaci  'aitx.axx'  ) 

faava  'P06B3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  actuator  3  fallura  flltar,  107 
// 

fbk-fbk>.01| 

f>fcon; 

b-bconi 

h>hcon; 

//f( I ,ll)-c*14; 

b( ! ,3)>ccl4; 

bb-bbcon; 

bb( i , 3 ) •cxS I 

axaci 'atx.axx'  ) 

faava  'r07B3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

//  actuator  4  fallura  flltar,  108 
// 

fbk-fbk>.01 j 
fafcon; 
b«bcon; 
h'hcon; 

//f( I ,12)-cil4; 

b( ; ,4)-cxl4} 

bb'bbcon; 

bb( : , 4 )«ca8 ; 

axaci 'Btx .axx' ) 

ftava  'r08B3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  actuator  S  fallura  flltar,  109 
// 

fbk-fbk>.01; 

fofconi 

b«bconi 

h-hcon; 
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//t{ : , 13)>czl4  ; 
b( :  ,5)-c*14j 
bb'bbcon i 
bb( : , 5)-ci8 j 

•X«C( 'MtX.BXX' ) 

fsav*  'r09B3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 

//  ttnsor  1  fallura  filtar,  110 
// 

fbk-fbk^'.Oli 

{>fconi 

b-bcon; 

h-hconi 

h(l, : )-rzl4; 

bb-bbcon; 

exec(  '■tx.aixx' ) 

faava  'rlOB3.dat’  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 

//  aansor  2  fallura  filter.  111 
// 

fbk-fbk4^.01> 

fafcon; 

b>bconi 

h-hcon; 

h(2, !  )-ril4; 

bb-bbcon; 

axec( 'atx.axx' ) 

faava  'rilB3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  detak 

//  tensor  3  failure  filter,  fl2 

// 

fbk-fbk>.01| 

f-fcon; 

b-bcon; 

h-hconi 

h( 3,  :  )-ral4; 

bb»bbcon j 

exec< 'atx.axx' ) 

ftave  'ri2B3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  detek 

//  tensor  4  failure  filter,  113 
// 

fbk-fbk-^.Ol; 

f-fcon> 

b'bcon; 

h-hcon; 

h(4, : )-ril4; 

bb>bbcon) 

exec< 'atx.axx' ) 

ftave  'rl3B3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  detak 

//  tensor  5  failure  filter,  114 

// 

fbk-fbk't'.Ol; 

fafcon; 

b'bcon; 

h-hcon I 

h( 5, : )-r*14; 

bb-bbcont 

axec( 'atx.axx' ) 

ftave  'ri4B3.dat'  ... 
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fbk  aa  bb  phix  bd  cqd  h  9kf  r  ak  aklnv  datak 


//  tanaor  6  (allura  filter,  115 
// 

fbk-fbk>.01 j 
£"fconj 
b'bcon; 
h-hcon» 
h(6, : )-ril4; 
bb^bbcon; 
exact 'Mtx.axx' ) 
fcave  'Pl5B3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  detak 
// 

//  aeneor  7  failure  filter,  tl6 
// 

fbk-fbk4.01; 
f»fcon; 
b-bcon» 
h-hcon) 
h(7,;)-rxl4j 
bb>bbcon; 
exact 'atx.axx'  ) 
feave  ‘Pl6B3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  detak 

// 

// 

//  actuator  6  failure  filter,  |17 

//  thle  hae  been  removed,  but  can  be  uncommented  out 
//  orlqinally,  the  failed  act  6  filter  was  #10, 

//  but  la  now  appended  on  to  the  end  tea  filter  #17) 
//  If  uaed. 

// 

//fbk-fbk+.Ol; 

//f-fcon» 

//b-bcon> 

//h-hcon; 

////ft !,14)-cal4; 

//bt ! ,6)-cxl4; 

//bb-bbcon; 

//bbt  J ,6 )-ca8; 

//exact 'mtx.mxx' ) 

//feave  'P10B3.dat'  ... 

//fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  detak 
// 

return 
// 
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SETUPB4.HXX  HATRIXX  EXECUTABLE  MACRO 


// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 


Date 

Date 


Author 

created 

revised 


Capt  Gre90cy  L.  Stratton 
20  Au9Uit  1991 
26  Septenber  1991 


Thii  Macro  creates  and  saves  to  files  all  the  required 
Matrices  for  a  single  bank,  as  used  in  NHAESIN.  This 
is  norMally  called  froM  the  Macro  PILECREATE.NXX,  however, 
it  can  be  used  by  itself  as  long  as  the  below  listed 
variables  currently  exist  in  MSMory  in  MStrixx. 

Below  are  listed  the  required  input  Matrices  and  variables: 


aa, 

bbcon, 
9. 
9<1. 
<J- 
fcon, 
bcon, 
hcon, 
delt, 
n, 
bank , 
csl4 , 
cx8, 
rsl4 , 

Note: 


The  8x8  plant  Matrix 
The  8x6  plant  B  Matrix 

The  white  Gaussian  noise  Multiplier  Matrix  (at  in  G*w(t)) 

An  identity  Matrix  of  size  14x14 

The  white  Gaussian  noise  covariance  Matrix 

The  14x14  plant  Matrix  augaented  with  1st  order  actuators 

The  14x6  B  Matrix  of  the  augMented  systeM 

The  7x14  8  Matrix  of  the  Measureaent  equation 

The  saeple  tiae  (here  1/64  Hz) 

nuaber  of  states  of  the  auoaented  systea  (here  14) 
nuaber  of  bank  of  which  filters  are  being  created 


coluan  vector  of 
coluan  vector  of 
row  vector  of  14 


14  zeros 
8  zeros 
zeros 


any  of  the  variables  above  with  'con'  in  its 
contain  rows  or  coluans  of  zeros,  siaulating 
detected  first  failure. 


naae  aay 
an  already 


This  Macro  creates  14  files  of  the  fora;  rxxB4.DAT 
where  xx  is  the  filter  nuaber  (04  thru  17) 

This  Macro  calls  the  aacro  ’atx.Mxx*  which  generates  the  required 
Matrices  for  each  filter. 


START  MACRO 


fully  functional  filter,  104 


fbk-.04+bank/10000; 

f-faug; 

b-baug; 

bb-borlg; 

h-horlg; 

exec ( 'atx . axx '  ) 

fsave  'P04B4.dat'  ... 

fbk  aa  bb  phix  bd  cqd 


h  gkf  r  ak  akinv  detak 


// 

//  also  save  the  fully  functional  case  to  the  first 
//  three  'filters'  (truth  Models)  so  as  to  have  at 
//  least  soaething  to  start  with 

// 

//  usually  the  first  truth  aodel  (f01B4.dat)  will 
//  be  the  fully  functional  case,  and  f02B4.dat  and 
//  f0384.dat  will  hold  the  first  single  and  double 

//  failure  truth  models  respectively 
// 

fsave  'f03B4.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  detak 
fsave  'f02B4.dat'  ... 
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fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv 
ftava  'f01B4.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv 
/  / 


detak 

detak 


gkf  r  ak  akinv  datak 


//  actuator  1  fallura  filtar,  #05 
// 

fbk-fbk>.01; 

f>fcon) 

b»bcon) 

h-hconi 

//f( I ,9)*cil4j 

b( t , 1 )>czl4 ; 

bb-bbconi 

bb( ; ,l)-cxS; 

axaci  'aitx.Kxx' ) 

faava  'P05B4.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv 

//  actuator  2  fallura  filtar,  #06 
// 

fbk-fbk«.01; 

f>fconi 

b>bcon; 

hohcon; 

//f( 1 ,10)>cxl4; 

b( : ,2)-c*14» 

bb'bbcon; 

bb( i , 2 )>cz8; 

axac( 'atx.axx' ) 

faava  'P06B4.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv 

//  actuator  3  fallura  filtar,  #07 
// 

fbk-fbk>.01; 

f-fcon; 

b'bcon; 

h*hcon; 

//f( ! ,ll)-cil4> 

b(:,3)-ctl4; 

bb-bbcon{ 

bb( : ,3)-c*8; 

axac( 'atx.axx' ) 

faava  'r07B4.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv 

//  actuator  4  fallura  filtar,  #08 
// 

fbk-fbk+.Ol; 
f«fcon; 
b«bcon ; 
h«hcon; 

//IK  ! , 12 )-czl4 ; 
b(  !  ,4)-czl4; 
bb<*bbcon  > 
bb( ; , 4 )-cz8; 
axaci 'atx.Hxx'  ) 
faava  'P08B4.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv 

//  actuator  5  fallura  filtar,  #09 
// 

fbk-fbk4.01) 

f«fcon; 

b-bcon; 

h»hconi 


datak 


datak 


datak 


//t{ : ,13)-czl4« 
b( ; ,S)-c«14; 
bb-bbcon; 
bb( : , S)-csB i 
tx«c( 'atx .Mxx'  ) 

Csav*  'r09B4.dat'  ... 

fbk  «•  bb  phlx  bd  eqd  h  qkf  t  ak  akinv  datak 

//  tansor  1  fallura  flltar,  110 
// 

Cbk-Cbk^.Ol) 

f>fconi 

b-bconj 

h-hcon; 

h(l , :  )-rcl4) 

bbabbconi 

axac( 'atx.axx' ) 

ftava  'rlOB4.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 


//  sanaor  2  failura  filtac.  111 
// 

fbk-fbk>.01) 

f>fcon> 

b>bcon; 

h«hconi 

h(  2, : )-r*14 j 

bb^bbcont 

axac(  'aitx.axx'  ) 

ftava  'PllB4.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

//  tantor  3  fallura  filtar,  112 
// 

fbk-fbk4.01; 

f«fcon; 

b-bcon; 

h«hconi 

h( 3, j )>rsl4; 

bb^bbconi 

axac( 'atx.axx' ) 

ftava  'P12B4.dac'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

//  tantor  4  failura  filtar,  113 
// 

fbk-fbk#,01; 

f«fcon; 

b-bcon( 

h-hcon J 

h(4,  :  )tx14; 

bb>bbcon ; 

axec( 'Htx.axx'  ) 

ftava  'P13B4.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  tantor  5  failura  filtar,  114 
// 

fbk-fbk>.01; 


f-*con  J 

b-bcon; 

h-hconi 

h(5, : )>rtl4| 

bb«bbcon> 

axac( 'atx.axx'  ) 

ftava  'P14B4.dat'  ... 
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fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

//  fcnaor  6  fallura  filtar,  415 
// 

fbk-fbk4.01; 
f "f con; 
b«bcon; 
h»hconi 
h(6, t )-rzl4; 
bb-bbcon; 
txac(  'atx.aixx'  ) 
faava  'rlSB4.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

//  sanaor  7  fallura  flltar,  116 
// 

fbk-fbk^.Ol; 
f«fcon; 
b«bcon; 
h>hcon; 
h(7, s )-rzl4| 
bb>bbcon ; 
axac( 'Mtx.axx' ) 
faava  'rl6B4.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  c  ak  akinv  datak 

// 

// 

//  actuator  6  fallura  flltar,  117 

// 

//  this  has  baan  raaoved,  but  can  ba  unconaentad  out 
//  oriqlnally,  tha  fallad  act  6  flltar  was  110, 

//  but  la  now  appandad  on  to  tha  and  (as  flltar  417) 
//  If  uaad. 

// 

//fbk-fbk*.01; 

//f«fcon; 

//b»bcon; 

//h«hcon; 

////f(!,14)-c*14; 

//b( : ,6)>czl4; 

//bb-bbcon; 

//bb( !  ,6)«cz8| 

//axac( 'atx .axx' ) 

//faava  'P10B4.dat'  ... 

//fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

raturn 
// 

Va 
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// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 


sbtupbS.hxx  hatrixx  executable  macro 

Author:  Capt  Gra9ory  L.  Stratton 
Data  craatad:  20  Auguat  1991 
Data  ravited:  26  Saptaabar  1991 

This  aacro  craataa  and  savas  to  fllas  all  tha  raquirad 
astricaa  for  a  sinqla  bank,  as  utad  in  NNAESIN.  This 
is  noraally  callad  froa  tha  aacro  riLECREATE.HXX,  howavar, 
It  can  ba  usad  by  Itsalf  as  long  as  tha  balow  llstad 
varlablas  currantly  axlst  In  aeaory  in  aatrlxx. 

Balow  ara  llstad  tha  raquirad  Input  aatrlcas  and  varlablas: 


//  aa,  Tha  8x6  plant  aatrlx 

//  bbcon,  Tha  8x6  plant  B  Matrix 

//  g,  Tha  whlta  Gaussian  nolsa  Multipliar  Matrix  (as  in  G*w(t)) 

//  gd.  An  Idantlty  Matrix  of  sisa  14x14 

//  q,  Tha  whlta  Gaussian  nolsa  covarianca  Matrix 

//  fcon,  Tha  14x14  plant  Matrix  augaantad  with  1st  ordar  actuators 

//  bcon,  Tha  14x6  B  Matrix  of  tha  augaantad  systaa 

//  hcon,  Tha  7x14  H  Matrix  of  tha  aaasuraaant  aquation 

//  dalt,  Tha  saapla  tiaa  (hera  1/64  Hx) 

//  n,  nuabar  of  atatas  of  tha  augaantad  systaa  (hara  14) 

//  bank,  number  of  bank  of  which  filters  ara  being  craatad 

//  czl4,  coluan  vector  of  14  zeros 

//  cz8,  coluan  vector  of  8  zeros 

//  rzl4,  row  vector  of  14  zeros 


//  Note:  any  of  the  variables  above  with  'con'  in  its  naaa  aay 
//  contain  rows  or  coluans  of  zeros,  siaulatlng  an  already 

//  detected  first  failure. 


// 

//  This  aacro  creates  14  f 
//  where  xx  is  tha  filter  : 

//  This  aacro  calls  tha  aa 
//  Matrices  for  each  fllta 
// 

// 

//  START  MACRO 

// 

// 

//  fully  functional  filter,  #04 
// 

fbk- . 04+bank/10000; 
f'faug; 
b-baug; 
bb'borig; 
h'horig; 
axac( 'Btx.axx' ) 
fsave  'P04BS.dat'  ... 
fbk  aa  bb  phix  bd  cqd  h  gkf 


This  aacro  creates  14  files  of  tha  fora:  PxxB5.DAT 
where  xx  is  tha  filter  nuabar  (04  thru  17) 

This  aacro  calls  tha  aacro  "atx.axx*  which  generates  tha  required 
Matrices  for  each  filter. 


fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 

// 

//  also  save  tha  fully  functional  case  to  tha  firat 
//  three  'filters'  (truth  Models)  so  as  to  have  at 
//  least  soaathing  to  start  with 
// 

//  usually  tha  first  truth  aodal  (f01BS.dat)  will 
//  ba  tha  fully  functional  case,  and  f02BS.dat  and 
//  f03BS.dat  will  hold  tha  first  single  and  double 
//  failure  truth  aodals  raapactivaly 
// 

fsave  'f038S.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 
fsave  'f02BS.dat'  ... 
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fbk  aa  bb  phlx  bd 
eaava  'f01B5.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  1  fai 
// 

fbk-fbk4.01; 

fafcoil) 

b'bcon; 

h>hconi 

//£( « ,9)-ctl4; 
b( i,l)>cxl4) 
bb-bbcon; 
bb( : , 1 )>cs8 1 
axaci 'atx.axx' ) 
faava  'fOSBS.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  2  fai 
// 

fbk.fbk^.Olt 

f-fcon; 

b'bcon; 

h»hcon) 

//f( : ,10)-cxl4j 
b( !  ,2)>cxl4t 
bb'bbcon; 
bb( : ,2)>cx8; 
axaci 'atx.axx' ) 
faava  'r06B5.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  3  fai 
// 

fbk-fbk>.01} 

f«fconi 

b-bcon; 

h>hcon; 

//f(  i,U)-cil4; 
b( : ,3)-cil4j 
bb'bbcon; 
bb( : ,3)«ciB| 
axac( 'atx.axx'  ) 
faava  'r07BS.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  4  fai 
// 

fbk-fbk^.Ol; 
f>fcon; 
b«bcon I 
h«hconi 

//f( s ,12)-cil4; 
b(  : ,4 )>cxl4; 
bb-bbcon; 
bb( : .4)-ci8; 
axaci 'atx.axx'  ) 
faava  'r08BS.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  5  fai 
// 

fbk.fbk^.Oli 

f«fcon; 

b«bcon) 

h-hcon; 


cqd  h  qkf  r  ak  aklnv  datak 
cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  105 


cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  106 


cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  107 


cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  108 


cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  109 
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//«(:, 13)-ctl4j 

b( : ,5)-c*l4 j 

bb>bbconi 

bb( : , S)>cs8f 

tx«c( ‘Btx.axx’ ) 

f«av«  'r09B5.dat'  ... 

(bk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  aklnv  datak 


//  acnaor  1  fallura  filtar,  (10 
// 

fbk-fbk4-.01« 

f'fcont 

b'bcont 

h-hcon; 

h(l, ; )-rxl4; 

bb^bbcon; 

axac( 'atx .«xx' ) 

faava  'FlOBS.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  9kf  r  ak  aklnv  datak 


//  aantor  2  fallura  filtar,  til 
// 

fbk-fbk^.Ol) 

f'fcon; 

b«bcon; 

h>hcon) 

h(2, ! )«r*14> 

bb>bbcon; 

axac( 'atx.Kxx' ) 

faava  'fllB5.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  9kf  r  ak  aklnv  datak 


//  sanaor  3  fallura  filtar,  112 
// 

fbk-fbk^.01> 

f>fcon j 

b'bcon; 

h«hcon> 

h(  3, s )-rxl4 j 

bb*ibbcon; 

axac( 'atx .axx' ) 

faava  'Pl2BS.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 


//  sanaor  4  fallura  filtar,  113 
// 

fbk-fbk>.01; 

f>fcon; 

b'bcon; 

h>hcon> 

h(4, s )-rsl4; 

bb»bbcon ; 

axac( 'atx.axx' ) 

faava  'P13B5.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 


//  sanaor  S  fallura  filtar,  114 
// 

fbk-fbk^.Ol; 

f-fcon; 

b-bcon; 

h-hcon; 

h(5, ! )-ril4; 

bb-bbcon; 

axac( 'atx .axx' ) 

faava  'P14B5.dat'  ... 
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bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
failura  flltar,  |1S 


fbk  aa 

// 

//  tansor 
// 

fbk-fbk4..01| 
{•fconi 
b-bconi 
h-hconi 
h(6, : )>rxl4; 
bbobbconi 
axac( '■tx.axx' ) 
faava  'P15BS.dat' 
fbk  aa  bb  phlx  bd 
// 

//  sanaor  7 
// 

ebk-fbk«.01> 

f>fcon; 

b>bconi 

h-hcon; 

h(7, : )«ril4| 

bb'bbconi 

axac( 'atx.axx' ) 


cqd  h  qkf  r  ak  aklnv  datak 
failura  flltar,  IK 


faava 

fbk  aa 

// 


rl6B5.dat' 
bb  phlx  bd 


cqd  h  qkf  r  ak  aklnv  datak 


actuator  6  failura  flltar,  117 


this  haa  baen  raaovad, 
orlqlnally,  tha  fallad 
but  la  now  appandad  on 
if  uaad. 


// 

// 

// 

// 

// 

// 

// 

// 

//tok«fbk+.01 j 
//f -fcon j 
//b-bcon; 

//h"hcon j 
////f( :,14)-cil4; 
//b( : .6)«cxl4j 
//bb-bbcon> 

//bb( I ,6)-cx8; 
//axac( ’■tx.axx* ) 
//faava  'PlOB5.dat' 
//fbk  aa  bb  phlx  bd 
// 

raturn 

// 

Va 


but  can  ba  uncoaaantad  out 
act  6  flltar  waa  110, 
to  tha  and  (aa  flltar  117) 


cqd  h  qkf  r  ak  aklnv  datak 
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SETUPB6.MXX  HATRIXX  EXECUTABLE  MACRO 


// 

// 

// 

//  Authoct  Capt  Cca9ory  L.  Stratton 

//  Data  craatad:  20  August  1091 

//  Data  ravlaad:  26  Saptaabac  1991 

// 

//  Thia  Macro  craatas  and  aavaa  to  fllaa  all  tha  raquirad 
//  aatrlcas  for  a  slngla  bank,  at  utad  in  HMAESIN.  This 
//  ia  normally  callad  from  tha  macro  PILECREATE.HXX,  howavar, 

//  it  can  ba  usad  by  itaalf  as  long  as  tha  balow  listad 
//  variablas  currantly  axist  in  memory  in  matrixx. 

// 

//  Balow  are  listad  tha  required  input  matrices  and  variablas: 

// 

//  aa,  Tha  8x8  plant  matrix 

//  bbcon,  Tha  8x6  plant  B  matrix 

//  a,  Tha  white  Gaussian  noise  multiplier  matrix  (as  in  G*w(t)) 

//  gd.  An  identity  matrix  of  site  14x14 

//  q,  Tha  white  Gaussian  noise  covariance  matrix 

//  fcon,  Tha  14x14  plant  matrix  augmented  with  1st  order  actuators 

//  bcon,  Tha  14x6  B  matrix  of  tha  augmented  system 

//  hcon.  The  7x14  B  matrix  of  tha  maasuramant  aquation 

//  dalt,  Tha  sample  time  (hare  1/64  Rs) 

//  n,  number  of  states  of  the  augmented  systam  (hare  14) 

//  bank,  number  of  bank  of  which  filters  are  being  craatad 

//  csl4,  column  vector  of  14  saros 

//  cs8,  column  vector  of  8  saros 

//  rsl4,  row  vector  of  14  saros 

// 

//  Note:  any  of  tha  variablas  above  with  'con'  in  its  name  may 
//  contain  rows  or  columns  of  saros,  simulating  an  already 

//  detected  first  failure. 

// 

//  This  macro  creates  14  files  of  tha  fora:  PxxB6.DAT 
//  where  xx  is  the  filter  number  (04  thru  17) 

//  This  macro  calls  the  macro  ‘atx.axx*  which  generates  the  required 
//  matrices  for  each  filter. 

// 

// 

//  START  MACRO 

// 

// 

//  fully  functional  filter,  104 
// 

fbk-.04>bank/10000; 

f«faug; 

b-baug ; 

bb-borlg; 

h'horlg; 

exec( ' atx .mxx '  ) 

fsave  'P04B6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 
// 

//  also  save  the  fully  functional  case  to  the  first 
//  three  'filters'  (truth  models)  so  as  to  have  at 
//  least  something  to  start  with 
// 

//  usually  the  first  truth  model  (f0lB6.dat)  will 
//  be  tha  fully  functional  case,  and  f02B6.dat  and 
//  f03B6.dat  will  hold  the  first  single  and  double 
//  failure  truth  models  respectively 
// 

fsave  'fC3B6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 
fsave  'f02B6.dat'  ... 
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fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 
faavt  'f01B6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

//  actuator  1  fallura  filtac,  lOS 
// 

fbk-fbk«.0I( 

f'fconi 

b'bconi 

h'hcont 

//i{ I ,9)-CXl4| 

b(t,l)-cil4j 

bb>bbconi 

bb( I tl)>ct8> 

axac( 'atx.axx' ) 

faava  'P0SB6.dat*  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  c  ak  akinv  datak 

// 

//  actuator  2  failura  filtar,  106 
// 

fbk-fbk^.Ol; 

f«fconi 

b>bconi 

h-hcont 

//f ( 1 , 10)>czl4  ; 

b( ! ,2)-cxl4; 

bb-bbconj 

bb( i , 2 )*cz8 ; 

axac( '■tx.axx' ) 

faava  'P06B6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

//  actuator  3  failura  filtar,  f07 
// 

fbk-fbk4..01| 
fafconi 
b>bcon; 
h'hcon I 

//f(!,ll)-cal4; 
b( : ,3)>cil4; 
bb>bbcon j 
bb( : ,3)>cs8; 
axac( 'atx.axx' ) 
faava  'P0786.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  actuator  4  failura  filtar,  t08 
// 

fbk-fbk4^.01> 

f>fcon> 

b>bcon; 

h-hcon) 

//f(:,12)-cal4; 

b( : , 4 )-cal4 ; 

bb>bbcon; 

bb( : ,4)«cx8; 

axaci 'atx .axx' ) 

faava  'P08B6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  actuator  S  failura  filtar,  109 
// 

fbk-fbk*.01; 

f'fcon; 

b'bconi 

h«hcon; 
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//£( t ,13)>cxl4) 
b(:,S)-ctl4| 
bb-bbconi 
bb( t (S)-ct8) 
tx«c( 'atx.axx' ) 
*sav«  ‘r09B6.dat' 
(bk  aa  bb  phlx  bd 
// 

//  sanaoc  1 
// 

fbk-£bk«.01i 
f>fconi 
b>bcon; 
h-hcon; 
h(l, ; )*rxl4} 
bb'bbcon; 
axac( 'atx.axx' ) 
(tava  'P10B6.dat' 
(bk  aa  bb  phlx  bd 
// 

//  aantoc  2 
// 

.01; 


cqd  h  qk(  r  ak  akinv  datak 
(ailura  (lltar,  #10 


cqd  h  qkf  r  ak  akinv  datak 
(ailura  (lltac,  #11 


cqd  h  gk(  r  ak  akinv  datak 
(ailura  (lltar,  112 


(bk-(bk>. 

(■(con; 
b-bcon; 
h'hcon; 
h(2, : )>rxl4; 
bb^bbcon; 
axac( 'atx.axx' ) 

(tava  'rilBd.dat' 

(bk  aa  bb  phlx  bd 
// 

//  aanaor  3 
// 

(bk-(bk>.01; 

(■(con; 

b^bcon; 

h^hcon; 

h(  3. : )*rxl4; 

bb»bbcon; 

axac( 'atx.axx' ) 

(tava  'P12B6.dat'  ... 

(bk  aa  bb  phlx  bd  cqd  h  9k(  r  ak  akinv  datak 

// 

//  tantor  4  (ailura  (lltar,  #13 
// 

(bk-(bk^.01; 

(■(con; 

b^bcon; 

h^hcon; 

h(4, ! )^rxl4; 

bb'bbcon; 

axacC 'atx.axx' ) 

(tava  'P13B6.dat'  ... 

(bk  aa  bb  phlx  bd  cqd  h  gk(  r  ak  akinv  datak 

// 

//  tantor  S  (ailura  (lltar,  #14 
// 


(bk^(bk>.01; 

(■(con; 

b^bcon; 

h^hcon; 

h(5, I )«rxl4; 

bb^bbcon; 

axac( 'atx.axx' ) 

(tava  'P14B6.dat'  ... 
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fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akl  nv  datak 

// 

//  aantoc  6  falluca  (lltar,  IIS 
// 

fbk-ebk4.01) 

fafconi 

b-bconi 

h-hcon; 

h(6, 1  )«rc14; 

bb'bbconj 

axac( 'atx.axx' ) 

ftava  'PlSB6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

//  aanaor  7  failura  flltar,  116 
// 

fbk-fbk^.Ol} 

f«fconi 

b-bconi 

h-hcon; 

h(7, 1  )-rxl4; 

bb-bbcon; 

axac( 'Btx.axx' ) 

faava  ‘P16B6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

// 

//  actuator  6  falluca  filtar,  tl7 
// 

//  this  haa  baan  raaovad,  but  can  ba  uncoauaantad  out 
//  oriqinally.  tha  failad  act  6  filtar  was  110. 

//  but  it  now  appandad  on  to  tha  and  (aa  filtar  117) 
//  if  uaad. 

// 

//fbk-fbk+.Ol; 

//f-fcon; 

//b-bcon ; 

//h-hcon; 

////f( j,14)-cal4; 

//b( 5 ,6)-cal4| 

//bb-bbcon ; 

//bb( ; ,6 )-ca6; 

//axac( 'atx.Bxx' ) 

//faava  'P10B6.dat'  ... 

//fbk  aa  bb  phix  M  cqd  h  qkf  c  ak  akinv  datak 

// 

raturn 

// 


D-4I 


SETUPB7.HXX  HATRIXX  EXECUTABLE  KACRO 


Author:  Capt  Gragory  L.  Stratton 
Data  craatad:  20  August  1991 
Data  ravlsad:  26  Saptanbar  1991 

This  *acro  craatas  and  savas  to  filas  all  tha  raqulred 
■atricas  for  a  slngla  bank,  as  used  In  IHAESIH.  This 
Is  noraally  callad  froa  tha  aacro  PILECREATE.MXX,  howavar. 

It  can  ba  usad  by  Itself  as  long  as  tha  balow  listed 
variables  currently  exist  In  aaaory  In  aatrlxx. 

Below  are  listed  tha  required  Input  aatrlcas  and  variables: 

aa,  Tha  8x8  plant  aatrlx 

bbcon,  Tha  8x6  plant  B  aatrlx 

g,  Tha  white  Gaussian  nolsa  aultlpllac  aatrlx  (as  In  G*w(t)) 

gd,  An  identity  aatrlx  of  size  14x14 

q.  Tha  white  Gaussian  nolsa  covariance  aatrlx 

fcon,  Tha  14x14  plant  aatrlx  augaentad  with  1st  order  actuators 

boon.  Tha  14x6  B  aatrlx  of  tha  augaentad  systaa 

hcon,  Tha  7x14  H  aatrlx  of  tha  aaasuraaent  aquation 

dalt,  Tha  saapla  tlaa  (hare  1/64  Ht) 

n,  nuabar  of  states  of  tha  auaaantad  systaa  (hare  14) 

bank,  number  of  bank  of  which  filters  are  being  created 

ctl4,  column  vector  of  14  taros 

cz8,  coluan  vector  of  8  zeros 

rzl4,  row  vector  of  14  zeros 

Note:  any  of  tha  variables  above  with  'con'  In  Its  name  nay 

contain  rows  or  columns  of  zeros,  slaulatlng  an  already 
detected  first  failure. 

This  aacro  craatas  14  files  of  tha  fora:  PxxB7.DAT 
where  xx  is  the  filter  nuabar  (04  thru  17) 

This  aacro  calls  the  aacro  "atx.axx*  which  generates  the  required 
matrices  for  each  filter. 


START  MACRO 


// 

//  fully  functional  filter,  104 
// 

fbk-.04>bank/10000; 

f-f aug ) 

b-baug; 

bb-borlg; 

h'horlg; 

axac( 'atx.axx' ) 

fsava  'P04B7.dat'  ... 


fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  aklnv  datak 

// 

//  also  save  tha  fully  functional  case  to  tha  first 
//  three  'filters'  (truth  models)  so  as  to  have  at 
//  least  something  to  start  with 

// 

//  usually  tha  first  truth  model  (f01B7.dat)  will 
//  be  the  fully  functional  case,  and  f02B7.dat  and 
//  f03B7.dat  will  hold  tha  first  slngla  and  double 
//  failure  truth  models  raspactlvaly 
// 

fsava  'f03B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  aklnv  datak 
fsava  'f02B7.dat'  ... 
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fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  detak 
faava  'e01B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 

//  actuator  1  fallura  flltar,  lOS 
// 

fbk-fbk«.01; 

fafconi 

b'bcon; 

h>hconi 

//£( : ,9)-cxl4» 

b( :  ,l)-cil4> 

bb-bbcon> 

bb( : , 1 )>cx8i 

ax«c( 'atx.axx' ) 

faava  'rOSB7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 

//  actuator  2  fallura  flltar,  |06 
// 

fbk-fbk«.01} 

f»fcon/ 

b>bcon; 

hahconi 

//f( 1 ,10)-cxl4; 

b( : ,2)«czl4; 

bb-bbcon) 

bb( : ,2)«cx8; 

exac( 'atx.axx' ) 

faava  'r06B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 

//  actuator  3  fallura  flltar,  *07 
// 

fbk-fbk+.Ol; 

fafcon; 

b'bconi 

h«hcon; 

//f( ! ,ll)-ctl4; 
b{:,3)-c*14; 
bb^bbcon i 
bb( : , 3 )-cz8 ; 
axac( 'atx.axx' ) 
faava  'r07B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  detak 

//  actuator  4  fallura  flltar,  #08 

// 

fbk-fbk>.01; 

fafcon; 

b-bcon; 

h-hconi 

//f( : ,12}-czl4; 

b(  :  ,4)-ctl4; 

bb>bbcon> 

bb( : , 4 )«cz8 ; 

axac( 'atx.axx' ) 

faava  'P08B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  t  ak  aklnv  datak 

//  actuator  5  fallura  flltar,  #09 
// 

fbk-fbk+.Ol; 

fafconi 

b»bcon> 

hohcon; 
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//f( I ,13)-csl4) 
b(  1 ,5)>czl4; 
bb>bbcon; 
bb( t , 5)-cc8) 

«x«c( 'atx.axx' ) 
fcava  'r09B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  sanaor  1  fallura  filter,  110 
// 

fbk-fbk>.01) 

f-fconj 

b»bcon) 

h-hcon; 

h(l, ! )-r*14; 

bb-bbcon; 

exec( ‘atx.axx* ) 

ftave  'P10B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  aklnv  dctak 
// 

//  aensoc  3  failure  filter.  111 
// 

fbk-fbk>.01; 

f-fcon; 

b«bcon) 

h-hcon; 

h(2, : )-rtl4; 

bb-bbconj 

exec(  'atx.axx'  ) 

ftave  'rilB7.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  aklnv  detak 

// 

//  tensor  3  failure  filter,  112 
// 

fbk-fbk>.01; 

f-fcon; 

b-bcon  j 

hohconi 

h(3, ! )-r»14; 

bb-bbcom 

exec( 'atx.axx'  ) 

ftave  ’P12B7.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  aklnv  datak 

// 

//  tensor  4  failure  filter,  113 
// 

fbk-fbk^.Ol; 

f-fcon; 

b-bcon; 

h-hcon ; 

h(4, ] )-rzl4; 

bb-bbcon; 

exec(  'atx.axx'  ) 

ftave  'P13B7.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  aklnv  detak 

// 

//  tensor  S  failure  filter,  114 

// 

fbk-fbk^.Ol; 

f-fcon; 

b-bcon ; 

h-hcon; 

h( 5, I )-rzl4 ; 

bb-bbcon; 

exec(  'Mtx.axx'  ) 

ftave  'P14B7.dat'  ... 
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(bk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  aenaor  6  failura  filtar,  #1S 
// 

fbk-fbk4.01} 
f-fcon; 
b'bcon; 
h-hcon; 
h(6, : )>ral4) 
bb>bbconi 
axac(  'Btx .axx' ) 
ftava  'Pl5B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  aantor  7  failura  filtar,  116 
// 

fbk-fbk>.01; 
f-fcon) 
b-bcon) 
h-hcon) 
h(7, ; )-rzl4) 
bb-bbcon) 
axac( 'atx.axx' ) 
ftava  'Pl6B7.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

// 

//  actuator  6  failura  filtar,  117 

// 

//  thlt  hat  baan  raaovad,  but  can  ba  uncoaaantad  out 
//  orlqlnally,  tha  fallad  act  6  filtar  vat  110, 

//  but  It  now  appandad  on  to  tha  and  (at  filtar  117) 
//  if  utad. 

// 

//fbk-fbk+.Ol) 

//f-fcon) 

//b-bcon) 

//h-hcon) 

////f( : ,14)-cxl4) 

//b( s ,$)-C(14) 

//bb-bbcon) 

//bb( ; ,6)-ct8) 

//axaci 'atx.axx' ) 

//ftava  'P1087.dat'  ... 

//fbk  aa  bb  phlx  bd  cqd  h  gkt  r  ak  akinv  datak 
// 

raturn 

// 

Va 
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SBTUPB8.HXX  MATRIXX  EXECUTABLE  MACRO 


Author 
Date  created 
Date  revised 


Capt  Gregory  L.  8 
20  August  1991 
26  Septeabar  1991 


Stratton 


This  Macro  creates  and  saves  to  files  all  the  required 
matrices  for  a  single  bank,  as  used  in  NNAESIH.  This 
is  normally  called  from  the  macro  PILECREATE.HXX,  however,' 
it  can  be  used  by  itself  as  long  as  the  below  listed 
variables  currently  exist  in  memory  in  aatrixx. 

Below  are  listed  the  required  input  matrices  and  variables: 


//  aa.  The  6x6  plant  matrix 

//  bbcon,  The  6x6  plant  B  matrix 

//  g.  The  white  Gaussisn  noise  multiplier  matrix  (as  in  G*w(t)) 

//  gd,  An  identity  matrix  of  size  14x14 

//  q,  The  white  Gaussian  noise  covariance  matrix 

//  fcon,  The  14x14  plant  matrix  augmented  with  1st  order  actuators 

//  bcon,  The  14x6  B  matrix  of  the  augmented  system 

//  hcon,  The  7x14  B  matrix  of  the  measurement  equation 

//  delt,  The  sample  time  (here  1/64  8t) 

//  n,  number  of  states  of  the  auomented  system  (here  II) 

//  bank,  number  of  bank  of  which  filters  are  being  created 

//  ctl4,  column  vector  of  14  teros 

//  cz6,  column  vector  of  6  zeros 

//  rzl4,  row  vector  of  14  zeros 

// 

//  Note:  any  of  the  variables  above  with  'con'  in  its  name  may 
//  contain  rows  or  columns  of  zeros,  simulating  an  already 

//  detected  first  failure. 

// 

//  This  macro  creates  14  files  of  the  fora:  PxxB6.DAT 
//  where  xx  is  the  filter  number  (04  thru  17) 

//  This  macro  calls  the  macro  ‘atx.axx*  which  generates  the  required 
//  matrices  for  each  filter. 

// 

// 

//  START  MACRO 

// 

// 

//  fully  functional  filter,  #04 
// 

fbk-.04+bank/10000; 
f-faug: 
b-baugi 
bb'borig; 
h-horig; 
exec( 'atx.axx' ) 
fsave  'r04B6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  aklnv  detak 

// 

//  also  save  the  fully  functional  case  to  t 
//  three  'filters'  (truth  models)  so  as  to 
//  least  something  to  start  with 

// 

//  usually  the  first  truth  model  (f01B8.dat 
//  be  the  fully  functional  case,  and  f02B8. 

//  f03B6.dat  will  hold  the  first  single  and 
//  failure  truth  models  respectively 
// 

fsave  'f03B6.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  detak 
fsave  'f02B0.dat'  ... 


fully  functional  filter,  104 


also  save  the  fully  functional  case  to  the  first 
three  'filters'  (truth  models)  so  as  to  have  at 
least  something  to  start  with 

usually  the  first  truth  model  (f01B8.dat)  will 
be  the  fully  functional  case,  and  f02B8.dat  and 
f03B6.dat  will  hold  the  first  single  and  double 
failure  truth  models  respectively 
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fbk  bb  phix  bd  cqd  h  qkf  c  ak  aklnv  datak 
faava  'f01B6.dat'  ... 

(bk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 
/  / 


//  actuator  1  failure  filter,  105 
// 

fbk-fbk4..01t 

f»fconi 

b^bcon; 

h-hcon; 

//f( :,9)-cxl4; 

b(  t  ,l)-cxl4| 

bb-bbconi 

bb( ! ,l)-cx8i 

execi 'atx.axx' ) 

faava  'rOSB8.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 

//  actuator  2  failure  filter,  408 
// 

fbk-fbk4-.01| 

f«fcon; 

b-bCOH) 

h'hcon; 

//f(t,10)-cxl4; 

b( : ,2)-csl4| 

bb-bbcon; 

bb( : ,2)>cx8; 

execi 'atx.axx' ) 

faava  'r08B8.dat’  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  detak 
//  actuator  3  failure  filter,  407 


faava  'r0780.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r 

// 

//  actuator  4  failure  filter, 


fbk  aa  bb  phix  bd  cqd  h  qkf  r 
// 

//  actuator  3  failure  filter, 
// 

fbk-fbk«.01; 

f-fcon; 

bobcon; 

h'hcon; 

//f( : ,ll)«cxl4; 
b( ;,3)-cal4» 
bb-bbcon I 
bb( I , 3 )-cx8| 
execi 'atx.axx' ) 
faava  'r0780.dat'  ... 
fbk  aa  bb  phix  bd  cqd  h  qkf  r 
// 

//  actuator  4  failure  filter 
// 

fbk-fbk«.01> 

f«fcon; 

b-bcon; 

h-hcon; 

//f( :,12)-cxl4; 
b( j ,4)-czl4; 
bb-bbcon; 
bb( : , 4 )-cz8 ; 
execi 'atx.axx' ) 
faava  'r08B0.dat'  ... 
fbk  aa  bb  phix  bd  cqd  h  qkf  r 
// 

//  actuator  5  failure  filter 
// 

fbk-fbk«.01; 

f-fcon; 

b-bcon; 

h-hcon; 


ak  aklnv  detak 


r  ak  aklnv  detak 
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//f ( t , 1 3 ) >ctl4 1 
b( : ,5)»cil4 j 
bb-bbcon ; 
bb( : .S)-ct8> 

•x«c( 'atx.Bxx' ) 
fsav*  'r09B8.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

//  sanaot  1  failure  filter,  810 
// 

fbk-fbk>.01| 

f-fcon; 

b'bcort; 

h-hcon> 

h(l. :  )-rxl4; 

bb-bbcon  > 

exec( 'atx .axx' ) 

faave  'riOB8.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

//  eeneor  2  failure  filter.  111 
// 

fbk-fbk4..01; 

f>fcon; 

b'bcon; 

h-hconi 

h(2, :  )-rxl4; 

bb-bbcon; 

exec( 'atx.axx' ) 

faave  'rllB6.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

//  senaor  3  failure  filter,  tl2 
// 

fbk-fbk«.01; 

f«fcon; 

b-bcon; 

h-hcon; 

h(3,!)-r*l4; 

bb-bbcon; 

exec(  'atx.axx' ) 

faave  'ri2B8.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 

// 

//  aenaor  4  failure  filter,  813 
// 

fbk-fbk>.01; 

f-fcon; 

b-bcon; 

h-hcon ; 

h(4, : )-ral4; 

bb-bbcon; 

execl 'atx .axx'  ) 

faave  'P13B8.dat’  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

//  aenaor  5  failure  filter,  814 
// 

fbk-fbk+.Ol; 

f-fcon; 

b-bcon; 

h-hcon; 

h(5, ; )-rzl4; 

bb-bbcon; 

exec( 'atx. axx'  ) 

faave  'Pl4B8.dat'  ... 


D-48 


fbk  aa  bb  phlx  bd  cqd  h  qkf  t  ak  aklnv  datak 
// 

//  aanaoc  6  fallura  filtar,  tlS 
// 

fbk-fbk4.01| 
f-fcon; 
b-bcon; 
h'hcon; 
h(6,i)-ril4| 
bb«bbconi 
axac( 'atx.axx* ) 
faava  'PlSB8.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  aanaor  7  fallura  filtar,  tl6 
// 

fbk-fbk«.01; 
f-fcon; 
b-bcon; 
h-hcon; 
h(7,!)-rxl4; 
bb-bbcon; 
axac( 'atx.axx' ) 
faava  'P16B8.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 

// 

// 

//  actuator  6  fallura  filtar,  117 
// 

//  thla  haa  bean  raaovad,  but  can  be  uncoaaentad  out 
//  orlqlnally,  tha  failed  act  6  filter  was  110, 

//  but  la  now  appended  on  to  tha  and  (aa  filter  117) 
//  If  uaed. 

// 

//fbk-fbk>.0l; 

//f-fcon; 

//b-bcon; 

//h-hcon; 

////f( s,14)-cal4; 

//b( s ,6)-csl4; 

//bb-bbcon; 

//bb( I ,6)-ca8; 

//axac(  'aitx.axx' ) 

//faava  'P10B8.dat'  ... 

//fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 

// 

return 
// 

/^ 
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SETUPB9.HXX  HATRIXX  EXECUTABLE  HACRO 


Author : 
Dat*  created: 
Date  revised: 


Capt  Gregory  L.  Stratton 
20  August  1991 
26  September  1991 


This  macro  creates  and  saves  to  files  all  the  required 
matrices  for  a  single  bank,  as  used  In  HKAESIH.  This 
Is  normally  called  from  the  macro  PILECREATE . HXX,  however, 
it  can  be  used  by  Itself  as  long  as  the  below  listed 
variables  currently  exist  in  memory  In  satrlxx. 

Below  are  listed  the  required  input  matrices  and  variables: 


//  bbcon, 
//  9. 

//  9<1. 

//  q. 

//  fcon, 
//  be on, 
//  hcon, 
//  delt, 
//  n, 
//  bank, 
//  csl4, 
//  ci8, 
//  rxl4. 


The  6x8  plant  matrix 
The  6x6  plant  B  matrix 

The  white  Gaussian  noise  multiplier  matrix  (as  in  G*w(t)) 

An  identity  matrix  of  size  14x14 

The  white  Gaussian  noise  covariance  matrix 

The  14x14  plant  matrix  augmented  with  1st  order  actuators 

The  14x6  B  matrix  of  the  augmented  system 

The  7x14  R  matrix  of  the  measurement  equation 

The  sample  time  (here  1/64  Hz) 

number  of  states  of  the  augmented  system  (here  14) 
number  of  bank  of  which  filters  are  being  created 
column  vector  of  14  zeros 
column  vector  of  8  zeros 
row  vector  of  14  zeros 


Note:  any  of  the  variables  above  with  'con'  In  its  name  may 

contain  rows  or  columns  of  zeros,  simulating  an  already 
detected  first  failure. 

This  macro  creates  14  files  of  the  fora:  PxxB9.DAT 
where  xx  is  the  filter  number  (04  thru  17) 

This  macro  calls  the  macro  "mtx.axx*  which  generates  the  requited 
matrices  for  each  filter. 


//  fully  functional  filter,  104 
// 

fbk-.04«bank/10000> 

f-faug I 

b-baug; 

bb-borlg; 

h-horig; 

exec( 'mtx.mxx' ) 

fsava  'P04B9.dat'  ... 


fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  detak 

// 

//  also  save  the  fully  functional  case  to  the  first 
//  three  'filters'  (truth  models)  so  as  to  have  at 
//  least  something  to  start  with 

// 

//  usually  the  first  truth  model  (f0lB9.dat)  will 
//  be  the  fully  functional  case,  and  f02B9.dat  and 
//  f03B9.dat  will  hold  the  firat  single  and  double 
//  failure  truth  models  respectively 
// 

fsave  'f03B9.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  detak 
fsava  'f02B9.dat’  ... 
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fbk  aa  bb  phix  bd  cqd  h  gkf  c  ak  aklnv  datak 
faavt  'f0lB9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  actuator  1  failuca  flltar,  t05 
// 

fbk-fbk«.01i 

fafcon; 

b-bconj 

h-hcont 

//f ( I ,9)*czl4> 

b( : ,l)-cxl4; 

bb-bbconi 

bb( ! , 1 )>ci0> 

axaci 'Btx.axx' ) 

faava  'r05B9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  actuator  2  fallura  flltar,  #06 
// 

fbk-fbk«.01; 

fofconi 

b-bcon; 

h^hconj 

//f(t,10)-c*14j 

b<  :  ,2)>cxl4; 

bb-bbcon; 

bb( : ,2)>cx8; 

axaci 'atx.axx' ) 

faava  'r06B9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 


//  actuator  3  lallxic*  flltar,  #07 
// 

fbk-fbk>.01; 
f-fcon> 
b>bcon } 
h«hconi 

//f(i,U)-cal4; 

b(i,3)«czl4f 

bb'bbcon; 

bb( I , 3)>cx0i 

axaci 'atx.axx' ) 

faava  'r07B9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 


//  actuator  4  fallura  flltar,  #00 
// 

fbk-fbk>.01; 

f'fconj 

b-bconi 

h-hcon; 

//f( :,12)-c*14> 

b( ; ,4}«cxl4; 

bb>bbcon; 

bb( : , 4 )>cx0; 

axaci 'atx.axx' ) 

faava  ’r08B9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 


// 

//  actuator  5  fallura  flltar,  #09 
// 

fbk-fbk«.01> 
f>fcon; 
b-bcon I 
h>hconr 
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//f( I ,13)>cxl4> 
b( :  ,S)-csl4) 
bb-bbconi 
bb( : ,S)«cx8) 

•  x«c( ’■tx.axx'  ) 
fsavt  'P09B9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  9k f  r  ak  akinv  datak 
// 

//  lantor  I  failure  filter,  110 
// 

fbk-fbk>.01; 

fafCOtl} 

b>bconi 

h-hcont 

h(l,:)-rtl4> 

bb-bbeon 1 

exec( 'atx.axx'  ) 

faave  'PlOB9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  detak 

// 

//  senaor  2  failure  filter.  111 
// 

fbk-fbk>.01; 

f-fcon; 

b'bcon; 

h-hcon j 

h(2, : )-rxl4; 

bbabbeon; 

exec( 'Btx .Hxx'  ) 

faave  'PllB9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  detak 

// 

//  tenaor  3  failure  filter,  tl2 
// 

fbk-fbkt.Ol; 

f-fcon> 

b«bcon; 

h-hcon> 

h( 3, i )«rtl4; 

bb^bbeon ; 

exec( 'atx .axx'  ) 

faave  'P12B9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 

// 

//  aenaor  4  failure  filter,  113 
// 

fbk-fbk«.01; 

f"fcon j 

b-bcon; 

h-hcon; 

h(4, ; )-ral4; 

bb-bbeon; 

exec( 'atx.axx' ) 

faave  ’P13B9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

//  aenaor  5  failure  filter,  114 
// 

fbk-fbk>.01; 

f-fcon; 

b-bcon; 

h-hcon; 

h(5, : )-ral4; 

bb-bbeon; 

exec{ 'atx.axx' ) 

faave  ’P14B9.dat'  ... 
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fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  aensor  6  fallura  filtar,  tlS 
// 

fbk-fbk^.Ol; 

f-£con; 

b-bcon; 

h'hcon; 

h(6, : )>rxl4; 

bb-bbconi 

axac( 'atx.axx' ) 

faava  'PlSB9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  aentor  7  fallura  flltar,  116 
// 

fbk-fbk^'.Ol; 

f^fconj 

b-bconi 

h>hcon) 

h(7, !  )tx14; 

bb'bbcon; 

axac( 'atx .axx ' ) 

faava  'ri6B9.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 

// 

// 

//  actuator  6  fallura  flltar,  117 
// 

//  thla  haa  baan  renovad,  but  can  ba  uncomnantad  out 
//  originally,  tha  fallad  act  6  flltar  waa  110, 

//  but  la  now  appandad  on  to  tha  and  (aa  flltar  tl7) 
//  If  uaad. 

// 

//fbk-fbk*.01; 

//f«fcon; 

//b«bcon  t 
//h-hcon; 

////f( : ,l4)-ctl4; 

//b( ! ,6)-cal4; 

//bb-bbcon j 
//bb( ! ,6)-ci8» 

//axaci  '  atx  .  Btxx  ’  ) 

//faava  'PlOB9.dat'  ... 

//fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  aklnv  datak 

// 

raturn 


// 
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SETUPXO.MXX  KATRZXX  EXECUTABLE  MACRO 


Author 
Date  created 
Date  revlted 


Capt  Cre9ory  L.  S 
20  Au9utt  1991 
26  September  1991 


Stratton 


Thlt  macro  create*  and  aavea  to  filet  all  the  required 
matrlcea  for  a  tlnql*  bank,  at  used  In  HHAESIN.  Thlt 
it  normally  called  from  the  macro  PlLECREATB.HXX,  however, 

It  can  be  uted  by  Ittelf  at  lonq  at  th*  below  lltted 
variable*  currently  cxltt  In  memory  In  matrlxx. 

Below  are  lltted  the  required  Input  matrlcet  and  variable*; 

aa,  Th*  6x0  plant  matrix 

bbcon,  Th*  8x6  plant  B  matrix 

9,  The  whit*  Gauttlan  nolte  multiplier  matrix  (a*  In  G*w(t)) 
9d,  An  Identity  matrix  of  tit*  14x14 
q,  The  white  Gauttlan  nolte  covariance  matrix 

fcon,  Th*  14x14  plant  matrix  au9a*nted  with  lat  order  actuator* 
bcon,  The  14x6  B  matrix  of  the  auqmented  tyttem 

hcon,  Th*  7x14  H  matrix  of  th*  meaiurement  equation 

delt,  Th*  temple  time  (her*  1/64  Hi) 

n,  number  of  etatet  of  the  auomented  tyttem  (here  14) 

bank,  number  of  bank  of  which  filter*  are  belnq  created 

czl4,  column  vector  of  14  zero* 

cz8,  column  vector  of  8  zero* 

rzl4,  row  vector  of  14  zero* 

Note:  any  of  the  variable*  above  with  'con'  In  Itt  name  may 

contain  row*  or  column*  of  zero*,  ilmulatinq  an  already 
detected  flrtt  failure. 

Thlt  macro  create*  14  filet  of  th*  form;  PxxX0.DAT 
where  xx  it  the  filter  number  (04  thru  17) 

This  macro  callt  th*  macro  "mtx.mxx*  which  generate*  the  required 
matrices  for  each  filter. 


START  MACRO 


// 

// 

//  fully  functional  filter,  #04 
// 

fbk-.04+bank/10000; 

f -f auq I 

bobauq ; 

bb«bor iq ; 

h-hor iq ! 

ex*c( ' mtx . mxx ' ) 

ftave  'r04X0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 

// 

//  also  save  the  fully  functional  case  to  the  first 
//  three  'filters'  (truth  models)  so  as  to  have  at 
//  least  something  to  start  with 

// 

//  usually  th*  first  truth  model  (f0lX0.dat)  will 
//  be  the  fully  functional  case,  and  f02x0.dat  and 
//  f03x0.dat  will  hold  th*  flrtt  tingle  and  double 
//  failure  truth  models  respectively 
// 

ftave  '  f03X0.dat'  . . . 

fbk  aa  bb  phlx  bd  cqd  h  qkf  c  ak  akinv  detak 
f save  ' f02x0.dat'  . . . 
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fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 
ftava  'f01X0.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  actuator  1  failuca  filtar,  iOS 
// 

fbk-fbkt.Ol) 
f«fcon j 
b"bcont 
h-hcon; 

//f(:,9)-ctl4j 

b(  1 , 1  )«czl4 ; 

bb-bbcon> 

bb( ! , 1 )>cx6; 

axac( 'Mtx.BXx' ) 

ftava  'P0SX0.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  actuator  2  fallura  filtar,  106 
// 

fbk-fbk4.01> 
f-fcon; 
b'bcon ; 
h-hcon i 

//f ( : ,10)-ctl4; 
b(  :  ,2)-c*14; 
bb-bbcon ; 
bb( : ,2)-cz8) 
axeci 'Btx.Bxx'  ) 
ftava  'P06X0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 
// 

//  actuator  3  failura  filtar,  107 

// 

fbk-fbk+.Ol j 
f-fcon; 
b-bcon; 
h-hcon; 

//f( ! ,ll)-czl4; 
b(  !  , 3)-czl4; 
bb-bbcon ; 
bb( : , 3)-cz8; 
axaci  'atx  .aucx'  ) 
ftava  'f07X0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  actuator  4  failura  filtar,  108 
// 

fbk-fbk«.01; 
f-fcon ( 
b-bcon; 
h-hcon; 

//f( :,12)-czl4; 

b(  :  ,  4  )-czl4  ; 

bb-bbcon; 

bb( ; , 4 ) -cz8 ; 

axac( 'Btx.Bxx' ) 

ftava  'r08x0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  actuator  S  failura  filtar,  109 
// 

fbk-fbk«.01; 
f-fcon; 
b-bcon ; 
h-hcon; 
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//f( : ,13)-cil4> 
b(  I , S  )-czl4 ; 
bb-bbcon  > 
bb( t ,S)-ci8; 
txec ( ' atx . Bxx ' ) 
fsavt  ’r09x0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 
// 

//  tentor  1  tailuca  filtar,  tlO 


// 

fbk-fbk«.01; 

f-fconi 

b>bcon I 

h>hcon) 

h( 1, : )-rxl4 ; 

bb-bbcon; 

axac( 'Btx.Bxx' ) 

ft.  va  'rl0x0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  c  ak  akinv  datak 

// 

//  tantor  2  failura  filtar.  111 
// 

fbk-fbk-f.Ol; 

f-fcon» 

b-bcon  t 

h>hcon; 

h(2, : )-fxl4; 

bb'bbcon) 

axac( 'Btx.axx'  ) 

ftava  'PllX0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  c  ak  akinv  datak 

// 

//  tantor  3  failura  filtar,  112 
// 

fbk-fbk>.01; 

f'fcon; 

b«bcon; 

h-hconi 

h(  3,  s )>rtl4  ; 

bb>bbcon ; 

axac(  'atx.axx' ) 

ftava  'P12x0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 
// 

//  tantor  4  failura  filtar,  113 
// 

fbk-fbk-»..01« 

f-fconi 

b-bcon> 

h»hcon ; 

h(4,  :  )-r*14; 

bb-bbcon; 

axac( 'atx.axx' ) 

ftava  'P13x0.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

// 

//  tentor  5  failura  filtar,  114 

// 

fbk-fbk>.01; 

f<ifcon; 

b-bcon ; 

h-hcon ; 

h( 5, :  )>rtl4  I 

bb-bbcon > 

exac( 'atx.axx' ) 

ftava  'ri4x0.dat'  ... 
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fbk  aa  bb  phlx  bd  cqd  h  qkf  c  ak  aklnv  detak 

//  sensor  6  failure  filter,  US 

// 

fbk-fbk4..01; 
f'fconj 
b'bconi 
h-hconj 
h(6, :  )-rsl4; 
bb-bbconi 
exec( 'atx.Bxx' ) 
fsave  'rlSx0.dat'  — 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  detak 

//  sensor  7  failure  filter, 

// 

fbk-fbk-f.Ol; 
f-fcon; 
b-bconi 
h»hcon> 
h(7, I )>rsl4; 
bb'bbcon; 
exec( 'Mtx.exx' ) 
fsave  'rl6X0.dat' 

fbk  aa  bb  phlx  bd  cqd  h  qkf  t  ak  aklnv  detak 

// 

// 

// 

// 

// 

// 

// 

// 

// 

//fbk-fbk+ . 01 » 

//f-fcon; 

//b-bcon; 

//h»hcon; 

////f( : ,14)-cxl4; 

//b( ! ,6)-csl4; 

//bb-bbcon; 

//bb< ! ,6)»cz8; 

//execi '■tx.Bxx' ) 

//fsave  'ri0x0.dat'  ... 

//fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  detak 

// 

return 

// 

'/a 


actuator  6  failure  filter,  |17 

this  has  been  reaoved,  but  can  be  uncoaaented  out 
orlqlnally,  the  failed  act  6  filter  was  110, 
but  Is  now  appended  on  to  the  end  (as  filter  #17) 
if  used. 
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SBTUPXl.NXX  HATRIXX  EXECUTABLE  KACRO 


// 

// 

// 

//  Author:  C«pt  Gregory  L.  Stratton 

//  Data  craatad;  20  August  1991 

//  Data  ravlsed:  26  Saptambar  1991 

// 

//  This  aacro  craatas  and  savat  to  filat  all  tha  raqulrad 
//  aatricas  for  a  tlngla  bank,  as  used  in  NMAESIM.  This 
//  Is  noraally  called  froa  tha  aacro  PtLECREATE.MXX,  howevar, 

//  it  can  ba  usad  by  Itsalf  as  long  as  tha  balow  listad 
//  variablas  currantly  axist  in  aaaory  in  aatrixx. 

// 

//  Balow  ara  listad  tha  raquirad  input  aatricas  and  variablas; 

// 

//  aa,  Tha  6x8  plant  aatrix 

//  bbcon,  Tha  6x6  plant  B  aatrix 

//  g,  Tha  whita  Gaussian  noisa  aultipliar  aatrix  (as  in  G*w(t)) 

//  go,  An  idantlty  aatrix  of  slta  14x14 

//  q,  Tha  whita  Gaussian  noisa  covarianca  aatrix 

//  fcon,  Tha  14x14  plant  aatrix  augaantad  with  1st  ordar  actuators 

//  bcon,  Tha  14x6  B  aatrix  of  tha  augaantad  systaa 

//  hcon,  Tha  7x14  H  aatrix  of  tha  aaasureaant  aquation 

//  dalt,  Tha  saapla  tiaa  (hara  1/64  Bs) 

//  n,  nuabar  of  statas  of  tha  augaanted  systea  (hara  14) 

//  bank,  nuaber  of  bank  of  which  flltars  ara  baing  craated 

//  czl4,  coluan  vactor  of  14  taros 

//  ci8,  coluan  vactor  of  8  taros 

//  rtl4,  row  vector  of  14  taros 

// 

//  Nota:  any  of  tha  variablas  abova  with  'con'  in  its  naaa  aay 
//  contain  rows  or  coluans  of  taros,  siaulating  an  already 

//  detected  first  failure. 

// 

//  This  aacro  creates  14  files  of  tha  fora;  PxxXl.DAT 
//  where  xx  is  tha  filter  nuabar  (04  thru  17) 

//  This  aacro  calls  the  aacro  *atx.axx'  which  generates  tha  required 
//  aatricas  for  each  filter. 

// 

// 

//  START  HACRO 

// 

// 

//  fully  functional  filter,  104 
// 

fbk-.04«bank/10000; 

f-faug; 

b-baug; 

bb-borig; 

h-horig; 

axac( 'atx.axx' ) 

fsava  'P04Xl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  detak 

// 

//  also  save  tha  fully  functional  case  to  the  first 
//  three  'filters'  (truth  aodals)  so  as  to  have  at 
//  least  something  to  start  with 

// 

//  usually  tha  first  truth  aodal  (fOlXl.dat)  will 
//  ba  tha  fully  functional  case,  and  f02xl.dat  and 
//  f03xl.dat  will  hold  tha  first  single  and  double 
//  failure  truth  models  raspactivaly 
// 

fsava  'f03Xl.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  datak 
fsava  'f02Xl.dat'  ... 


fbk  aa  bb  phlx  bd 
fiava  'fOlxl.dat' 
fbk  aa  bb  phlx  bd 

// 

//  actuator  1  fai 
// 

fbk-fbk>,0X j 
f-fcon; 
b-bcon; 
h'hconi 

//f ( t ,9)-ctl4; 
b(  t , 1 )>cxl4 1 
bb-bbcon; 
bb( : . 1 )-cs8> 
axaci ’■tx.Mxx* ) 
faava  'P0Sxl.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  2  fal 
// 

fbk-fbk*.01i 

fafCOH) 

b'bcon ; 
h>hcon) 

//f(  :  ,10)-ciJ.4; 
b( t ,2)-czl4| 
bb-bbconj 
bb( :,2)-ci8; 

•xcc( 'atx.Mxx' ) 
faava  'P06xi.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  3  fal 
// 

fbk-fbk4.01; 
f>fconi 
b-bcon; 
h>hcon ; 

//f ( ; ,ll)-c*14; 
b( ; , 3 )-czl4  j 
bb^bbcont 
bb( : , 3)*cz8; 
axaci 'atx.axx' ) 
faava  'r07Xl.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  4  fal 
// 

fbk-fbk+.Ol; 
f-fcon; 
b-bcon ; 
h-hcon j 

//f<  j,12)-czl4; 
b( : ,4)-czl4; 
bb-bbcon ; 
bb( ; , 4 )-cz8 ; 
axac(  'aitx.axx' ) 
faava  'roexl.dat' 
fbk  aa  bb  phlx  bd 
// 

//  actuator  S  fal 
// 

fbk-fbk«.01; 

f-fcon; 

b-bcon; 

h-hcon; 


cqd  h  9kf  t  ak  aklnv  datak 
cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  IDS 


cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  106 


cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  107 


cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  808 


cqd  h  qkf  r  ak  aklnv  datak 
lura  flltar,  109 
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//t( : .13)-c*14; 

b( !  ,S)«czl4) 

bb>bbcon; 

bb( ; , S )-cz8 i 

tx«c(  'atx.aixx'  ) 

ftav*  'r09xl.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  9k(  r  ak  aklnv  datak 
// 

//  aanaor  1  fallura  filter,  tlO 
// 

fbk-fbkt.Oli 

f'fconr 

b'bconi 

h'hconi 

h(l , : )«rzl4 I 

bb'bbcon ) 

axec(  'atx.aixx'  ) 

faave  'riOxl.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akl  nv  detak 

// 

//  aenzor  2  failure  filter.  111 
// 

fbk-ebk>.01> 

f«fconi 

b-bcon ) 

h-hcon; 

h(2, : )-rzl4; 

bb*ibbcon) 

exec( 'atx.axx' ) 

feave  'rilXl.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

//  scneor  3  failure  filter,  112 
// 

fbk-fbk4.01; 

fxfcon; 

b>bcon} 

h«hcon; 

h(3, I )«czl4i 

bb-bbcon> 

exec( 'atx.axx' > 

faave  'ri2xl.dat’  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  detak 

// 

//  aenaor  4  failure  filter,  113 
// 

fbk-fbk«.01; 

fafcon; 

b>bcon I 

h'hcon; 

h(4,  !  )«rzl4; 

bb-bbcon; 

exec< 'atx.axx' ) 

faave  'ri3Xl.dat’  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 

// 

//  aenaor  5  failure  filter,  114 
// 

fbk-fbk^.Ol; 

f>fcon; 

b'bcon; 

h*hcon  f 

h(5, s )>rzl4; 

bb'bbcon; 

exec( 'Btx .■XX' ) 

faave  'ri4Xl.dat’  ... 
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fbk  ••  bb  phlx  bd  c<)d  h  fkf  r  ak  akinv  datak 


//  aanaoc  6  fallura  filtar,  IIS 
// 

fbk-fbk».01 j 
f-fcon; 
b-bcont 
h>hcon; 
h(6, :  )-rzl4i 
bb-bbconi 
axac( 'atx.axx' ) 
faava  'rlSxl.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 

//  lanaor  7  fallura  filtar,  116 
// 

fbk-fbk«.01; 
fafcon; 
b-bcon  t 
hahcont 
h(7, t )-r»14; 
bb'bbcon; 
axac( 'atx.axx' ) 
faava  'ri6Xl.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  c  ak  akinv  datak 

// 

//  actuator  6  fallura  filtar,  117 

//  this  has  been  raaovad,  but  can  ba  uncoaaantad  out 
//  orlqlnally,  tha  failed  act  6  filtar  was  #10, 

//  but  Is  now  appended  on  to  tha  and  (as  filtar  #17) 
//  if  usad. 

// 

//fbk-fbk4.01 j 
//f-fcon; 

//b-bcon j 
//h-hcon j 
////f( I ,14)-csl4> 

//b( t ,< )-csl4 ; 

//bb-bbconj 
//bb( I ,#)>cs8; 

//axac( 'Btx .Bxx' ) 

//fsava  ’fl0xl.dat'  ... 

//fbk  as  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 
// 

raturn 

// 

/A 
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SETUPX2.KXX  HATRIXX  EXECUTABLE  HACRO 


// 

// 

// 

//  Author:  Capt  Gregory  L.  Stratton 

//  Date  created:  20  Auguat  1991 

//  Date  revlaed:  26  Septeaber  1991 

// 

//  Thia  Macro  creates  and  aavea  to  (ilea  all  the  required 
//  Matrices  (or  a  single  bank,  as  used  in  MKAESIH.  This 
//  is  normally  called  (roa  the  macro  PILECREATE.MXX,  however, 

//  it  can  be  used  by  ItseK  as  long  as  the  below  listed 
//  variables  currently  exist  in  memory  in  aatrlxx. 

// 

//  Below  are  listed  the  required  input  matrices  and  variables: 

// 

//  aa.  The  8xS  plant  matrix 

//  bbcon.  The  8x6  plant  B  matrix 

//  g.  The  white  Gaussian  noise  multiplier  matrix  (as  in  G*w(t)) 

//  gd.  An  identity  matrix  o(  site  14x14 

//  q.  The  white  Gaussian  noise  covariance  matrix 

//  (con.  The  14x14  plant  matrix  augmented  with  1st  order  actuators 

//  boon.  The  14x6  B  matrix  o(  the  augmented  system 

//  hcon.  The  7x14  R  matrix  o(  the  measurement  equation 

//  delt.  The  sample  time  (here  1/64  Rs) 

//  n,  number  o(  states  o(  the  augmented  system  (here  14) 

//  bank,  number  o(  bank  o(  which  (liters  are  being  created 

//  csl4,  column  vector  o(  14  teros 

//  cs8,  column  vector  o(  8  teros 

//  rtl4,  row  vector  o(  14  teros 

// 

//  Note:  any  o(  the  variables  above  with  'con'  in  its  name  nay 
//  contain  rows  or  columns  o(  teros,  simulating  an  already 

//  detected  (irst  (allure. 

// 

//  This  macro  creates  14  (lies  o(  the  form:  fxxX2.DAT 
//  where  xx  is  the  (liter  number  (04  thru  17) 

//  This  macro  calls  the  macro  "ntx.mxx*  which  generates  the  required 
//  matrices  (or  each  (liter. 

// 

// 

//  START  HACRO 

// 

// 

//  (ully  (unctlonal  (liter,  104 
// 

(bk-.04'»bank/10000: 

(•(aug; 
b-baug  > 
bb'borigi 
h«horlg; 
exec( 'mtx.mxx' ) 

(save  'P04X2.dat'  ... 

(bk  aa  bb  phix  bd  cqd  h  gk(  r  ak  akinv  detak 

// 

//  also  save  the  (ully  (unctional  case  to  the  (irst 
//  three  '(liters'  (truth  models)  so  as  to  have  at 
//  least  something  to  start  with 
// 

//  usually  the  (irst  truth  model  ((01X2.dat)  will 
//  be  the  (ully  (unctional  case,  and  (02X2.dat  and 
//  (03X2.dat  will  hold  the  (irst  single  and  double 

//  (allure  truth  models  respectively 
// 

(ssve  '(03x2.dat'  ... 

(bk  aa  bb  phix  bd  cqd  h  gk(  r  ak  akinv  detak 
(save  '(02X2.dat'  ... 
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fbk  aa  bb  phix  bd  cqd  h  qkt  r  ak  akinv  datak 
ftava  'fOlx2.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

//  actuator  1  fallura  fUtar,  #05 
// 

fbk-fbk+.Ol; 
fafcon) 
b>bcon; 
hohcon I 

//f ( 1 ,9)-cil4 j 

b(  i , 1  )-cxl4; 

bb-bbcon; 

bb( I , 1 )~cs8 I 

axaci ‘atx .■xx* ) 

fiava  'rOSX2.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

//  actuator  2  fallura  filtar,  |06 
// 

fbk-fbk4.01) 
f-fcon; 
b^bcon ; 
h>hcon) 

//t( !  , 10 )-cil4  j 

b{!,2)-czl4; 

bb'bbcon) 

bb( : ,2)«cz8; 

axac( 'atx.axx' ) 

faava  'r06X2.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

//  actuator  3  fallura  filtar,  *07 

// 

fbk-fbk>.01; 

f'fcon; 

b-bconj 

h«hconi 

//f(  t  .llNczl4> 

b( : ,  3)-czl4; 

bb-bbcom 

bb( : , 3 )-cx8 i 

axac( 'atx.axx' ) 

faava  'r07X2.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

//  actuator  4  fallura  filtar,  |08 

// 

fbk-fbk«.01i 

fofcon; 

b-bcon; 

h-hconi 

//f ( : , 12 )-czl4 ; 

b(  :  ,4)-czl4| 

bb-bbcon; 

bb( : , 4 )>cz8; 

axac( 'atx.axx' ) 

faava  'p08X2.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 

//  actuator  5  fallura  filtar,  #09 
// 

fbk-fbk>.01; 
f'fcon; 
b-bcon ) 
h-hcon; 
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//£( ! ,13)-cil4; 
b( : ,5)-ccl4| 
bb'bbcon ; 
bb( : ,5)-ct6i 
•xec( '■tx .Mxx' ) 
ftava  'r09x2.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  aklnv  datak 

// 

//  aanaor  1  fallura  filtar,  110 
// 

fbk-fbk^.Ol; 

f'fconj 

b-bconj 

h«hconi 

h( 1 ,  !  )-rxl4  I 

bb-bbconi 

axac( '■tx .axx' ) 

faava  'P10x2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  9kf  r  ak  akinv  datak 

// 

//  aanaor  2  fallura  filtar.  111 
// 

fbk-fbk«.01> 

f>fcon; 

b>bcon; 

h-hcon j 

h(2, : )-ral4; 

bb-bbcon j 

axac(  'atx.atxx'  ) 

faava  'PllX2.dat*  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aklnv  datak 

// 

//  aanaor  3  fallura  filtar,  412 

// 

fbk-fbk«.01; 

fofcony 

b'bcon I 

h'hconi 

h( 3, I )-ral4; 

bb'bbcon; 

axac( 'atx .axx' ) 

faava  'P12x2.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aki  nv  datak 

// 

//  aanaor  4  fallura  filtar,  113 
// 

fbk-fbk^.Ol; 

f'fcon; 

bobcon; 

h>hcon ; 

h(  4 , ! )>rxl4 ; 

bb-bbcon> 

axac(  'Btx.aixx' ) 

faava  'P13x2.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  aklnv  datak 

// 

//  aanaor  5  fallura  filtar,  114 
// 

fbk-fbk^.Oli 

f>f con ) 

b-bcon; 

h"hcon; 

h(  S, ; )>rxl4; 

bb'bbcon; 

axac( 'atx .axx' ) 

faava  'P14x2.dat'  ... 
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fbk  aa  bb  pMx  bd  cqd  h  qkt  c  ak  akinv  detak 

//  aansor  6  failura  filter,  IIS 
// 

fbk-fbk>.01 I 
f-fcon» 
b-bcont 
h-hcon> 
h(6, :  )-r*ll; 
bb-bbconi 
exec( 'atx.axx'  ) 
faave  'rlSx2.dat' 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

//  aentor  7  failure  filter,  116 
// 

fbk-fbk>.01; 
fafcon; 
b>bcon ; 
hahcon; 
h(7, ! )-rxl4j 
bb-bbcon; 
exec( 'atx .axx'  ) 
faave  'Pl6x2.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

// 

// 

// 

// 

// 

// 

// 

// 

//fbk-fbk4.01; 

//f-fconj 
//b-bcon j 
//h-hcon; 

////f ( s ,ll)-cal4 j 
//b( : ,6)-cal4; 

//bb-bbcon j 
//bb( : ,6)>ca8i 
//execi  'aitx  .axx' ) 

//faave  'P10X2.dat'  ... 

//fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

return 

// 

//T 


actuator  6  failure  filter,  117 

thla  haa  been  reaoved,  but  can  be  uncoasented  out 
otlqlnally,  the  failed  act  6  filter  waa  110, 
but  la  now  appended  on  to  the  end  (aa  filter  117) 
If  uaed. 
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SETUPX3.HXX  HATRIXX  EXECUTABLE  MACRO 


// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 


Author  t 
Date  created: 
Date  revised: 


Capt  Gregory  L.  Stratton 
20  August  1991 
26  September  1991 


This  macro  c.eates  and  saves  to  files  all  the  required 
matrices  for  a  single  bank,  as  used  In  MNAESIM.  This 
Is  normally  called  from  the  macro  PILECREATE.HXX,  however, 
It  can  be  used  by  Itself  as  long  as  the  below  listed 
variables  currently  exist  in  memory  In  matrlxx. 

Below  are  listed  the  required  Input  matrices  and  variables; 


aa. 


,1: 


//  bbcon, 
// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 


gc 

<]• 
f  con , 
bcon, 
hcon, 
delt, 
n, 
bank , 
csl4 , 
cz6, 
rzl4 , 

Note : 


The  8x8  plant  matrix 
The  8x6  plant  B  matrix 

The  white  Gaussian  noise  multiplier  matrix  (as  In  G*w(t)) 

An  Identity  matrix  of  size  14x14 

The  white  Gaussian  noise  covariance  matrix 

The  14x14  plant  matrix  augmented  with  1st  order  actuators 

The  14x6  B  matrix  of  the  augmented  system 

The  7x14  H  matrix  of  the  measurement  equation 

The  sample  time  (here  1/64  Hz) 

number  of  states  of  the  augmented  system  (here  14) 
number  of  bank  of  which  filters  are  being  created 
column  vector  of  14  zeros 
column  vector  of  8  zeros 
row  vector  of  14  zeros 

any  of  the  variables  above  with  'con'  In  its  name  may 
contain  rows  or  columns  of  zeros,  simulating  an  already 
detected  first  failure. 


This  macro  creates  14  files  of  the  fora:  rxxX3.DAT 
where  xx  Is  the  filter  number  (04  thru  17) 

This  macro  calls  the  macro  *mtx.axx*  which  generates  the  required 
matrices  for  each  filter. 


START  MACRO 


fully  functional  filter,  104 


fbk-.04«bank/10000; 

f'faug) 

b-baugi 

bbaborlg: 

h-horlg; 

exec( 'mtx.axx' ) 

fsave  'P04X3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  gkf  r  ak  akinv  detak 


// 

//  also  save  the  fully  functional  case  to  the  first 
//  three  'filters’  (truth  models)  so  as  to  have  at 
//  least  something  to  start  with 
// 

//  usually  the  first  truth  model  (f01X3.dat)  will 
//  be  the  fully  functional  case,  and  f02X3.dat  and 
//  f03X3.dat  will  hold  the  first  single  and  double 
//  failure  truth  models  respectively 
// 

fsave  'f03x3.dat’  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  detak 
fsave  'f02X3.dat'  ... 
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fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  akinv  datak 
faava  'fOlx3.dat' 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 


actuator  1  fallura  flltac,  tOS 


// 

//  actuator  1 
// 

fbk-fbk>.01; 

fafcont 

b'bcon; 

h>hcon; 

//f ( : ,9)-cxl4; 
b( t , 1 )-cil4; 
bb-bbconi 
bb(:,l)-czei 
axaci  'atx  .aixx' ) 


faava  'r05x3.dat’  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 


fallura  filter,  #07 


//  actuator  2  fallura  filter,  106 
// 

fbk-fbk-».01> 
f  af  con; 
b>bconi 
h-hcon; 

//f( I ,10)-cxl4; 

b(  :  ,2)-cxl4; 

bb>bbcon; 

bb( : ,2)>cx8; 

axaci '■tx.Mxx'  ) 

faava  'r06x3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 

//  actuator  3  fallura  filter,  #07 
// 

fbk-fbk+.Ol; 

f«fcon; 

b^bcon; 

h>hcon; 

//f ( t , 11 )-cxl4  ; 

b( : , 3 )-cxl4  ; 

bb-bbcon; 

bb( : ,3)-cx8; 

axaci  'titx.axx’ ) 

faava  'r07x3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 

//  actuator  4  fallura  filter,  108 
// 

fbk-fbk«.01; 

f>fcon; 

b>bcon; 

h»hcon; 

//f( s ,12)-cxl4; 

b(  :  ,4)-cal4; 

bb-bbcon; 

bb( ! ,4)-cx8; 

axac(  'atx.aixx' ) 

faava  'r08x3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  gkf  r  ak  akinv  datak 

//  actuator  S  fallura  filter,  #09 
// 

fbk-fbk^.Ol; 

f>fcon; 

b-bcon; 

h'hcon; 


fallura  filter. 


failure  filter,  #09 


//f ( ! ,13)-cil4; 
b( I ,5)-cil4; 
bbxbbcon i 
bb( : ,5)-c*8; 

•  xtc( 'atx .mxx'  ) 
fsavt  'r09X3.dat'  ... 

fbk  aa  bb  phlx  bd  cqd  h  qkf  r  ak  aktnv  detak 


//  tensor  1  failure  filter,  110 
// 

fbk-fbk^.Ol; 

f'fconi 

b>bcon I 

h«hcon/ 

h( 1 , ! )>rxl4  t 

bb>bbcon; 

9xec(  'etx .exx'  ) 
ftave  'rl0x3.dat'  ... 

fbk  aa  bb  ph,'x  bd  cqd  h  qkf  r  ak  akinv  detak 


//  sensor  2  failure  filter,  til 

// 

fbk-fbk>.01; 

f-f con  I 

b>bcon ) 

h-hcon ) 

h(2,:)>rzl4; 

bb'bbcon ; 

exec( '«tx .mxx'  ) 

f  save  '  rilX3  .dat  ■'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 

// 

//  tensor  3  failure  filter,  fl2 
// 

fbk-fbk>.01; 

f«fcon; 

b'bconi 

h«hcon) 

h(3, : )-rsl4; 

bb>bbcon ; 

exec( 'etx.axx'  ) 

ftave  'ri2X3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 


// 

//  sensor  4  failure  filter, 
// 

fbk-fbk^.Ol; 
f-fcon; 
b-bcon ; 
h-hcon ; 


#13 


h( 4, ! )«ril4; 
bb-bbconi 
exact 'atx.axx'  ) 
ftave  'Pl3X3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 


//  sensor  5  failure  filter,  tl4 
// 

fbk-fbk>.01; 


f-fcon; 

b-bcon ; 

h-hcon; 

h(5, : )-ril4; 

bb-bbcon ; 

exact  ’atx  .tixx '  ) 

fsave  'P14X3.dat’  ... 
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fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 

// 

//  aanaor  6  fallura  filtac,  IIS 

// 

fbk-fbk«.01; 
f>f con; 
b«bcon; 
h-hcon; 
h(6, : )>rsl4; 
bb-bbcon; 

•xac( 'atx.axx' ) 
faava  'ri5X3.dat’  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  datak 
// 

//  ttntor  7  fallura  filtar,  116 
// 

fbk-fbk>.01; 

f-fcon; 

b-bcon; 

h-hcon; 

h(7,:)-rxl4; 

bb-bbcon; 

axac( 'atx.axx' ) 

faava  'ri6X3.dat'  ... 

fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 
// 


actuator  6  fallura  filtar,  117 


//  thia  haa  bean  reaoved,  but  can  be  uncoaaentad  out 
//  oriqinally,  the  failed  act  6  filtar  waa  110, 

//  but  la  now  appended  on  to  the  end  (aa  filter  117) 
//  If  uaed. 

// 

//fbk-fbk-f.Ol; 

//f-fcon; 

//b-bcon; 

//h-hcon; 

////f( ! ,14)-cxl4; 

//b( i ,6)-cal4; 

//bb-bbcon; 

//bb( ! ,6)-ca8; 

//exec( 'Btx.axx'  ) 

//faave  'ri0X3.dat'  ... 

//fbk  aa  bb  phix  bd  cqd  h  qkf  r  ak  akinv  detak 
// 

return 

// 

Va 
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APPENDIX  E;  DATAFILES 


This  appendix  contains  all  of  the  data  files  necessary  for  the  execution  of  the  MMAESIM  code.  The  data 
files  necessary  for  the  proper  execution  of  the  code  are  provided  within  this  section.  The  filter  single-failure 
data  files  are  not  presented  in  this  section,  with  the  exception  of  the  no-failure  filter.  Since  there  are  16  filters 
and  13  banks  (208  daU  filters),  presenting  these  filters  within  this  appendix  is  impractical.  The  no-failure  filter 
data  is  presented  to  represent  the  format  of  the  filter  data  files. 
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o  r>  n  n  n  n  n  nnnnnn  nnnnnnnnn  nnnnnn  nnnnnnnnnnnnnnnnnnnnnnnnnnnnnrinnn 


LOGICAL  CONTROL  FILE  -  (REALS.DAT]  it  called  froa 
SUBROUNTINE  GETOAT.  REALS.DAT  functions  at  an 
Input  data  tet  which  ptovidat  the  necettaty  real 
variables  and/or  initial  settings  for  HNAESIN 
to  begin.  By  placing  all  of  the  starting  real 
variables  within  a  single  logical  file,  it  becomes 
easy  to  adjust  the  sinulatlon  for  any  possible 
scenario  without  recompiling  the  code.  A  tingle 
locale  for  all  of  the  starting  real  variables 
provides  the  user  with  a  quick  reference  of  the 
scenario  under  investigation. 

CREATION  DATE:  6  July  1991 
REVISION  DATE:  8  July  1991 
Owner:  USAF/ASD/WL/AriT 


_ _ _ _ _  * 

HKAESIH  REAL  CONTROL  VARIABLES  * 

- - - - - - - - - -  * 


VAR  ->  TSAHP  :  Sampling  time  used  in  MKAESIN. 

Currently  this  it  set  to  run  at 
a  64  Ht  rate,  which  is 
TSAHP  -  1/(64  H*) . 

TSAHP  -  0.015625 


VAR  ->  PRBHIN 

PRBHIN  -  0.001 


Hinimum  allowed  probability  for 
any  one  filter. 


VAR  ->  PRBPLTRTO  ;  Probability  given  to  the  assumed 

’correct”  filter  at  time  zero. 

Each  of  the  other  remaining  filters 
are  assigned  a  probability  of 
(l-PRBrLTRT0)/( Ifilters-l) 

PRBFLTRTO  -  0.75 


VAR  ->  DSIH 

DSIH  •  8.0 


Simulation  running  time  in  seconds. 
Current  maximum  DSIH  is  15.625  seconds. 


VAR  ->  WGNFAC  :  White  Gaussian  noise  factor. 

WGNFAC  -  0.05 
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o  o  o  o  o  n  o  o  o  o  o  n  o  o  o  r»  r>  o  o  o  o  o  oooonoo  r»onnftnoor>  o  o  o  o  r>  o  o  o  r>  o  o  o  o  o  o  r»  o  o  o 


VAR  ->  ZBIASAMNT  i  Th«  array  of  bias  aaounta  that  «ay 

corrupt  tha  ■eaaureaenta .  Currantly, 
thara  ara  7  BaaturaBantt  used. 
NorBally,  If  a  biaa  arror  la  baing 
alBulatad  only  one  of  tha  BaaauraBanta 
would  ba  corruptad  with  a  bias,  and 
tha  othars  would  ba  zaro.  Balow  ara 
tha  ’suggeatad*  bias  SBounts  for  aach 
of  tha  sansor  Baasurasants . 


VELOCITY  < — > 
ALPHA  <  — > 
PITCH  RATE  <  — > 
LOAD  FACTOR  <--> 
ROLL  RATE  <--> 
YAW  RATE  <--> 
LAT.  ACCEL.  <  — > 


ZBIASAMNT! 1)  - 
ZBIASAMNT! 2)  - 
ZBIASAMNT! 3)  - 
ZBIASAMNT! 4)  - 
ZBIASAMNT! S)  - 
ZBIASAMNT! 6)  - 
ZBIASAMNT!?)  > 


ZBIASAMNT!!)  -  0.0 
ZBIASAMNT!2)  •  0.0 
ZBIASAMNT!!)  -  0.0 
ZBIASAMNT!  4)  •  0.0 
ZBIASAMNT!  S)  -  0.0 
ZBIASAMNT!6)  •  0.0 
ZBIASAlMNT!  7  )  •  0.0 


VAR  ->  TIMELAGl 

:  TlBa  in  which  tha  first  fallura 
occurs.  This  Bust  ba  graater  than 
or  aqual  to  zaro  and  lass  than 
TZNELAG2  !if  2nd  failura  is  being 
Bodeled) . 

TIMELAGl  -  3.0 

VAR  ->  TIMELAG2 

:  TiBs  in  which  tha  second  failura 
occurs.  This  Bust  ba  greatar  than 
or  aqual  to  TIMELAGl. 

TIMELAG2  •  3.1 

VAR  ->  DSEED 

Seed  providad  to  randoB  nuBbar 
generator . 

DSEED  -  754.5463 

-  ^  -  * 

TUNING 

VARIABLES  USED  IN  THE  Q  KATRIX  * 

TSIGll 

TSIG22 

TSIG33 

TSIG44 

TSIG55 

TSIG66 


Ttsigii  0  0  0  . 

I  TSIG22  0  0 

I  TSIG33  0 

I  TSIG44 

I 

(  !  SYM  ) 


0  I 
0  I 
0  I 
0  I 
0  I 
0  I 
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nr%  onnonooono  nnoo 


TSIG77  I  I 

TSIG86  I  TSIG68  | 


TSlGll  •  0.0 
TSIG22  -  0.0 
TSIG33  -  0.0 
TSIG44  •  0.0 
TSIG55  -  0.0 
TSIG66  -  0.0 
TSI077  -  0.0 
TSIGOa  -  0.0 


_ -  • 

END  or  HNAESIN  REAL  CONTROL  VARIABLES  * 

--- — -- — --- — • 


VAR  ->  H 
K  -  7.0 


NuAb«r  of  ■•nsora.  Currently  7. 
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nnnnnn  nnnnnnn  nnnnnnnnn  nnnnnnnnnnnnnnnnrtnrtnnctnnnnnnnnnnnnnnnnnnn 


uuuuuu  oowooow  woowoow  oowoooo  owwowuo  owouowu  owuuooo  ooouuoow 


H00eLN2  -  2 


FLAG  ->H0DBLN3 

H0DELN3  •  3 

FLAG  -> I START 

> 

I  START  -  0 

FLAG  ->WFLAG  ! 

HFLAG  •  1 

FLAG  ->NUHFAILS 

! 

NUHFAILS  -  2 

FLAG  ->NUHBANRS 

NUHBANKS  -13 

FLAG  ->BANK 

BANK  •  1 

FLAG  ->HIERABCHY 

HIERARCHY  -  0 

FLAG  ->XITER 

XITER  -  1 
C 


I  in  -  V»r  A  is  u»td,  (2)  -  V«r  B  It  uted 
Description  -  this  fla^  is  used  within 
HHAE  to  switch  between  loop  a  and  loop  b 


:  (1)  -  Var  A  is  used,  (2)  -  Var  B  is  used 
Description  -  this  flaf  is  used  within 
HHAE  to  switch  between  loop  a  and  loop  b 


(1)  -  Var  A  is  used,  (2)  -  Var  B  is  used 
Description  -  this  flag  is  used  within 
MKAE  to  switch  between  loop  a  and  loop  b 


:  (1)  -  Var  A  is  used,  (2)  -  Var  B  is  used 
Description  -  this  flag  is  used  within 
MMAE  to  switch  between  loop  a  and  loop  b 


:  (1)  -  var  A  is  used,  (2)  -  Var  B  is  used 
Description  -  this  flag  is  used  within 
HHAE  to  switch  between  loop  a  and  loop  b 


(1)  -  Var  A  Is  used,  (2)  -  Var  B  Is  used 
Description  -  this  flag  is  used  within 
HKAE  to  switch  between  loop  a  and  loop  b 


;  ID  -  var  A  is  used,  (2)  -  Var  B  is  used 
Description  -  this  flag  is  used  within 
HNAE  to  switch  between  loop  a  and  loop  b 


(IJ  -  Var  A  is  used,  (2)  -  Var  B  is  used 
Description  -  this  flag  is  used  within 
HHAE  to  switch  between  loop  a  and  loop  b 
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ouuuu  uuuouou  uouooo  uuuuuuuuuuuuuuuuuuuuuouuuuuuuuu 


FLAG  ->SBNSORBtAS  t  (1)  -  VAr  A  il  UtAd,  (2)  -  VAC  B  It  UAtd 
I  Detctlption  -  this  flA9  It  uttd  within 
MMAB  to  twitch  bttwAtn  loop  t  tnd  loop  b 


SENSORBIAS  -  0 


FLAG  ->FLTRT0  t  (1)  -  Vtr  A  it  uttd,  (2)  -  Vtr  B  it  uttd 
:  Dttcription  -  thit  flA9  it  uttd  within 
HMAB  to  twitch  bttwttn  loop  A  And  loop  b 

FLTRTO  -  4 


FLAG  ->NFLTR  :  (1)  -  VAt  A  it  Uttd,  (2|  -  Vtr  B  it  uttd 
:  Dttcription  -  thit  flA9  it  uttd  within 
HKAE  to  twitch  bttwttn  loop  A  And  loop  b 

NFLTR(l)  -  16 
NFLTR(2)  -  16 
NFLTRO)  •  16 
NFLTR(4)  -  16 
NFLTR(S)  •  16 
NFLTR(6)  «  16 
NFLTR(7)  -  16 
NFLTR(8)  •  16 
NFLTR(9)  -  16 
NFLTR(IO)  -  16 
NFLTR(ll)  -  16 
NFLTR(12)  «  16 
NFLTR(13)  -  16 
NFLTR(14)  -  0 
NFLTR(IS)  «  0 


LEVEL  1 


SUBROUTINE  (GCTDAT]  CONTROL  FLAGS  • 


SUBROUTINE  (PULLOUT)  CONTROL  FLAGS  * 
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o  o  o  o  o  o  f>  o  r>  o  o  o  o  o  o  o  fi  o  f>  o  rt  o  r>  o  o  oonoort  nnnnnnn  nnnrtnnnnnnnnnnnnnnnnnnrtnn 


SUBROUTINE 


I HATML ) 


CONTROL  rLACS 


_ _ _ _ _  • 

SUBROUTINE  (GGNMLl  CONTROL  FLAGS  • 

_ ... _ - _ _ _ _ _ _ _ - _ _  • 


_ _ _ _ _ _ _ - _ _ _ _ _ _  * 

SUBROUTINE  [RFILT]  CONTROL  FLAGS  * 

- - -  • 


FLAG  ->BANRFLAG 


BANRFLAG 


UBVU 


t  11!  -  Var  A  !•  ua*d,  (2)  -  Vat  _  .. 
Oascrlptlon  -  thia  fla9  la  uaad  within 
HMAE  to  awltch  batwaan  loop  a  and  loop  b 


FLAG  ->INITV2 

INITV2  «  0 
FLAG  ->1N1TV 

INITV  -  I 


:  (11  -  var  A  ia  uaad,  (2)  -  Var  B  la  uaad 
Oaacription  -  thla  fla9  ia  uaad  within 
NHAE  to  awitch  batwaan  loop  a  and  loop  b 


i  (1)  -  var  A  ia  uaad,  (2)  -  Var  B  ia  uaad 
i  Oaacription  -  thia  (la9  ia  uaad  within 
HHAE  to  awitch  batwaan  loop  a  and  loop  b 


-  • 

SUBROUTINE  (OEABN)  CONTROL  FLAGS  • 

-  • 


-  * 

SUBROUTINE  (PLTLSRl  CONTROL  FLAGS  * 

-  * 


SUBROUTINE  {TINE  AND  DATE]  CONTROL  FLAGS  * 
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LEVEL  2 


-  • 

SUBROUTINE  [BON]  CONTROL  FLAGS  * 

- - - - - - - - • 


FLAG  ->IACTORDR  :  (1)  -  First  order  actuator  Modal,  (2)  -  Second 

order  actuator  Model,  (4)  -  Fourth  order  actuator 
Model 

:  Description  -  this  flag  Is  used  within  EON  to 
select  the  actuator  Model. 

lACTORDR  -  1 


- - - — _ _ _ _ .... _ _ _ _ _ _  • 

SUBROUTINE  ( UPDATE J  CONTROL  FLAGS  * 

_ ... _ ... _ _ _ _  • 


FLAG  ->BCTAFLG  t  (1)  -  Vac  A  Is  used,  (2)  -  var  B  Is  used 
:  Description  -  this  flag  Is  used  within 
NHAE  to  switch  between  loop  a  and  loop  b 

BBTAFLG  -  0 


- -  e 

SUBROUTINE  (CNTRL)  CONTROL  FLAGS  • 

—  - - - - - _ _ _ _ _ _  • 


FLAG  ->ITRIHZ 


ITRIMZ  •  0 


:  (0)  -  Read  trlM  file,  (1)  -  do 
:  Description  -  this  flag  Is  used 
read  the  trlM  file  for  controls 


not  read  trlM  file 
within  CNTRL  to 
Initialisation 


-  • 

SUBROUTINE  lADPCON)  CONTROL  FLAGS  • 

-  • 


FLAG  ->ISLCT  ;  (1)  -  Var  A  Is  used,  (2)  -  Var  B  is  used 
:  Description  -  this  flag  is  used  within 
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KHAE  to  twitch  bttwtan  loop  a  and  loop  b 


ISLCT  -  3 


FLAG  ->DSeEO 

DSEBD  •  -6 


(1)  -  var  A  it  uttd,  (2)  -  Var  B  it  uttd 
Oatcrlption  -  thit  flag  la  uttd  within 
KHAE  to  twitch  between  loop  a  and  loop  b 


LEVEL  3 


_ _ _ _ _ _ - _ - _ _ _ _ _ _  • 

SUBROUTINE  I DSORT )  CONTROL  FLAGS  * 

_ _ _ _ _ _ _ _ _ _ _  * 


SUBROUTINE  (ACALC)  CONTROL  FLAGS 


lACTFAIL  -  0 
IACTFL2  -  5 
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DECLARATION  Of  VARIABLES  AND  COHMON  BLOCKS  fOR  NMAESIM 


REAL  Z(7) ,H(7,1«),HT(7,29) 

REAL  CQ0CNT(8,8),R(7,7),SMPLS 
DOUBLE  PRECISION  PI 

INTEGER  XITER . INITV, lACTORDR, DSEED, lACTPAIL, IACTPL2 
CHARACTER  CDATE*9 , CTIME*8 

REAL  TSIG11,TSIG22,TS1G33,TS1G44,TSIG55,TSIG66,TSIG77,TSIG88 

REAL  A(8,8) .B(8.6),C(29,29) 

REAL  AUNEW( 6 ) , PRBNEW( 20,15), PRBMIN, PRBPLTRTO , TSAHP 
REAL  XHPSUMC 14 ) , DSIH, WGNPAC, TIMELAGl , TIHELAG2 

INTEGER  NPLTR(15),ISLCT 
INTEGER  HODELN,Modelnl ,Hod*ln2,Hodeln3 
INTEGER  I  START , I STOP , P LTRTO , BETAPLC , NP LAG 
DOUBLE  PRECISION  M 

DOUBLE  PRECISION  OUT( 51 3 , 29 ) , DBPLECI 51 3 , 6 ) , INPUTS) 51 3 , 6 ) 
DOUBLE  PRECISION  STATES ( 51 3 , 8 ) , PROBS) 51 3 , 17 ) , TVEC( 51 3 , 1 ) 
DOUBLE  PRECISION  DUMHVJ , ACCEL) 51 3 , 2 ) , PRBBNK2 ( 51 3 , 17 ) 

DOUBLE  PRECISION  RSID) 192 , 91 ) , TSHORT) 192 , 1 ) , BDUSG) 192 , 91 ) 
DOUBLE  PRECISION  RSIOTWO) 192 , 91) , BDUSGTWO) 192 , 91 ) 


C 


C 


C 


c 


Eleaental  Piltac  Data  Arrays 

REAL  IA)8, 8, 20, 15), 28)8,8,20,15)  .  . 

BEAL  2PHIX)14,14,20,15),ZBD)14,8,20,15),ZCQDCN)8,8,20,15) 
BEAL  ZM)7,14,20,15),ZGRP)14,7,20,15)  ,ZR)7,7,20,15) 

REAL  ZAK) 7, 7, 20, 15 ),ZAKIMV) 7, 7, 20, 15 ),ZDeTAK) 20, 15) 

Rtiidual  and  Log  Likalihood  Declarations 


INTEGER  itiBa,ljk 

DOUBLE  PRECISION  rak r ) 51 3 , 7 , 1 0 , 20 ) 
DOUBLE  PRECISION  LR)513,7,20) 
DOUBLE  PRECISION  rssava ) 51 3 , 7 , 1 3 ) 
DOUBLE  PRECISION  bussava) 51 3, 7 , 1 3  ) 
REAL  blssava) 513,7,13) 


C  -  Saquantlal  and  Nultipla  Pailura  Varlablas 

INTEGER  nuNfails 

C  -  Santor  Bias  Variables 

INTEGER  Sensorbias 
REAL  Zbiasaaint)7) 

C  -  Hierarchical  Modeling  Variables 

CKARACTER*5  DPILE)20,15) 

CHARACTER* 5  BANKNAME)15) 

INTEGER  Nuabanks, Bank, Bankf lag, initv2 

C  -  Mean  and  Standard  Deviation  Variables 

INTEGER  ki,kj,kk 
REAL  TeMpl,Teap2 

DOUBLE  PRECISION  Haanprob) 3 , 16 ) , Stddev ) 3 , 16 ) 
C  -  Coda  Chacking  algorlthas 


E-n 


non 


c  Real  xdlfatatC  ),xdlfcon(  ) 
c  Real  Zdlfstati  ),Zdlfcon(  ) 
c  Real  h 


COMMON  BLOCK  DEFINITIONS 


COMMON/LOGF LAGS/IDIO, HODELN, MODELNl , M0DELN2 ,  MODELN3 , 1  START , 
(Wr LAG , NUMF AI LS , NUNBANKS , BANK , H I ERARCHY , XI TER ,  SENSORB I AS , 
tFLTRTO,NFLTR,BANKFLAG, INITV2 . INITV, lACTOROR , BETAFLG, ITRIMZ, 
tISLCT.OSEED, lACTFAIL, IACTFL2 

COMMON/RAWOAT/ZA ,ZB,ZPHIX,ZBD, ZCQOCN , ZH , ZGKF , ZR , 
aZAK, ZAKINV, Z DETAX, CODCNT^R 

COMMON/restet/rakr, i jk, Itlae, rt save, buz aave 

COMMON/CHRDAT/DF I LE , BANKNAME 

COMMON/CONTROLSZ/AONEW ,PRBNEW,XHPSUM,Z,H,BT 

COMMON/MATR I X/A , B . C 

COMMON/PLTI NF/OUT , DEFLEC , INPUTS , STATES , PROBS  ,  PRBBNK2 
COMMON/STATS/MEANPROB, STDDEV 

COMMON/REALDAT/TSAMP,PRBMIN,PRBFLTRTO,DSIM,WGNFAC,ZBIASAMNT, 

*TIMELAG1,TXMELA02,TSIC11,TSIG22,TSIC33,TSIC44,TSIG55,TSIC6$, 

(TSIG77,TSIG88,M 
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414.7300 

3.0071932E-04 

6.300000 

8.300000 
O.OOOOOOOE+00 

10.06086 
0.4200000 
1.000000 
O.OOOOOOOE+00 
-1.847997 
-4.9999952E-03 
-4.9999924E-03 
-5. 3007058E-03 

1.557974 

1.557974 
-0.4403729 
-2.660917 

1.500000 
10.06087 
-10.72676 
O.OOOOOOOE+00 
O.OOOOOOOE+00 
5090.137 

1.500000 
O.OOOOOOOE-t-OO 
-23.00000 

1 . 500000 
O.OOOOOOOE-t-OO 


1 . 266S000E-03 
20000.00 
-2.587025 
1.5625000E-02 
10.06088 
10.06086 
4.225569 
2 . 3841858E-07 
O.OOOOOOOE^OO 
O.OOOOOOOE+00 
4.9999924E-03 
4.9999924E-03 
O.OOOOOOOE^-OO 

1.557974 

1.557974 
0.4403729 
-2.660917 
O.OOOOOOOE+00 
10.06088 

14.40508 
0.0000000E*00 
3.3992767E-02 

14.40509 

1 . 500000 

O.OOOOOOOE+00 

O.OOOOOOOE^OO 

1.500000 

3.5762787E-07 


972.5400 

O.OOOOOOOE+00 

3.0071911E-04 

0.0000000E4.00 

22.02900 

10.06088 

0.9999998 

0.000000084-00 

6.3923690E-03 

0.6499329 

6.916890 

0.0000000E400 

1.260000 

-3.3401469B-02 

1.557974 

-6.6788890E-03 

-3.3394445B-02 

O.OOOOOOOE+00 

10.06088 

-2.000000 

O.OOOOOOOB4-00 

14.40509 

O.OOOOOOOB-t-OO 

1.500000 

1.500000 

O.OOOOOOOB4.00 

0.0000000E400 

-3.5762787E-07 


2116.200 
0.0000000E400 
3.0071911E-04 
O.OOOOOOOE+OO 
O.OOOOOOOE+00 
10.00000 
0.9999998 
O.OOOO0O0E4OO 
10.06088 
O.OOOOOOOE+OO 
-4 .9999866E-03 
O.OOOOOOOE+OO 

1.557974 

1.557974 

1.557974 
-3.3394445E-02 
-2.667595 
0.1165518 
14.40508 

14.40508 
O.OOOOOOOE+OO 

14.40509 
O.OOOOOOOE+OO 

1.500000 

1.500000 

1.500000 

1.500000 


0.4000000 

3.0071932E-04 

3.0071932E-04 

O.OOOOOOOE+OO 

10.06088 

10.06088 

1.000000 

O.OOOOOOOE+OO 

0.6499329 

4.9999952E-03 

4.9999866E-03 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

3.3401489E-02 

1.557974 

O.OOOOOOOE+OO 

1.557974 

10.06087 

14.34643 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

5090.137 

1.500000 

1.500000 

21.00000 

1.500000 

1.500000 
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FILTER  NAME  FILE  -  (FLTRNAHE.DAT]  it  called 
frOB  SUBROUTINE  GETOAT.  FLTRNAHE.DAT  functiont  at 
an  input  data  set  which  controlt  all  the  data  file 
readt  for  the  individual  Kalnan  filtert  within  each 
of  the  pottible  IS  banka  of  filtert.  Thit  input 
file  containt  the  filter  naaet  corretpondin9  to  a 
a  filter  data  file.  Subroutine  REDNAM.FOR  readt 
thia  file  and  loadt  a  common  block  CHRDAT  for  ute 
within  MHAESIN. 


CREATION  DATE:  10  July  1991 
REVISION  DATE;  11  July  1991 
Owner:  USAF/ASD/AFIT 


FILTER  BANK  NUMBER  11  * 
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FILTER  BANK  NUMBER  I  2  * 
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FILTER 

•  12 

F12B2 
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riLTER 

•  13 

F13B2 

FILTER 

•  14 
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FILTER  120  -  r20B7 
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APPENDIX  F:  NAECON  PAPER 


This  appendix  presents  a  paper  submitted  for  the  IEEE  National  Aerospace  and  Electronics  Conference 
(NAECON)  conference  on  May  20,  1992  in  Dayton,  OH.  This  paper  is  referenced  in  Chapter  4.  The  paper 
details  some  single-failure  data.  The  primary  contribution  of  the  data  within  the  paper  to  this  thesis  is  the 
investigation  and  development  of  the  dither  signals  used  throughout  this  thesis  effort 
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MULTIPLE  MODEL  ADAPTIVE  ESTIMATION  APPLIED  TO 
THE  VISTA  F‘16  FLIGHT  CONTROL  SYSTEM  WITH 
ACTUATOR  AND  SENSOR  FAILURES 

TlJDOthy  C.  K«n)c«  and  Patar  S.  Mayback 

Oepartaant  of  Blactricai  and  Coaputar  Bnglnaarlng 
Air  rorca  Inatltuta  of  Tachnology  /  BMC 
Wright -Pattaraon  AFB^  Ohio  45433 


AaaTBACT 

*4ultipie  aodel  adaptive  estimation  (^•4A£) 
IS  applied  to  the  Variable  In-fll^ht  Stability 
Test  Aircraft  (ViSTA)  F16  flight  control 
system  Sinqle  aetjator  and  hard  sensor 
failures  are  introduced  and  system  performance 
is  evaluated  Performance  is  enhanced  by  the 
application  of  a  eodlfied  Bayesian  form  of 
HHAE.  scalar  residual  acnltorlng  to  reduce 
ambiqult les.  ditherinq  where  advantageous/  and 
purposeful  cussMnds 

L .  iQcroductioo 

For  sany  app 1 icat Ions ,  it  is  highly 
desirable  to  develop  an  aircraft  flight  control 
system  with  recon f Lgu rable  capabt I 1 t ies :  able 
to  detect  and  Isolate  failures  of  sensors 
and/or  actuators  and  then  to  employ  a  control 
algorithm  that  has  been  specifically  designed 
for  the  Current  failure  mode  status.  One  means 
of  accomplishing  this.  In  a  manner  that  Is 
Ideally  suited  to  distributive  computation/  is 
mul t i pie  todel  adapt  I ve  est ima t Ion  (MMAC)  (1*4) 
and  control  (HKAC)  15‘71 

Assume  that  the  aircraft  system  Is 
adequately  represented  by  a  linear  perturbetlon 
stochastic  state  model,  with  a  (failure  statue) 
uncertain  parameter  vector  affecting  the 
matrices  defining  the  structure  of  the  model  or 
depict  tng  the  statistics  of  the  noises  entering 
It  Further  assume  that  the  parameter#  can 
take  on  only  discrete  values  cither  this  Is 
reasonable  physically  (as  for  sany  failure 
detection  f orsu lat Ions ) .  or  representative 
discrete  values  are  chosen  throughout  the 
continuous  range  of  possible  values  Then  a 
Kalman  filter  is  designed  for  each  choice  of 
parameter  value,  resulting  In  a  bank  of  A 
separate  ’elemental*  filters.  Based  upon  the 
observed  cha r act er 1 st I cs  of  the  residuals  lo 
these  K  filters,  the  conditional  probabilities 
of  each  discrete  paraseter  value  being 
‘correct*,  given  the  measurement  history  to 
that  time,  are  evaluated  Iteratively.  In  HMAC/ 
a  separate  set  of  controller  gains  is 
associated  with  each  elemental  filter  in  the 
bank  The  control  value  of  each  elemental 
controller  is  weighted  by  Its  corresponding 
probability.  and  the  adaptive  control  is 
produced  as  the  probability  weighted  average  of 
the  elemental  controller  outputs.  A#  one 
alternative  (using  maxlsum  a  posteriori,  or 
MAP.  rather  than  nlnisum  mean  square  error,  or 
MMSC.  criteria  for  optimality),  the  control 
value  from  the  single  elemental  controller 


associated  with  the  highest  conditional 
probability  can  be  selected  as  the  output  of  the 
adaptive  controller- 

previous  efforts  investigated  the 
application  of  a  multiple  model  adaptive  control 
algorithm  to  a  short  takeoff  and  landing  (STOL) 
r-lS  (B.9).  The  system  was  modeled  with  four 
elemental  controllers  designed  for  a  healthy 
aircraft,  failed  pitch  rate  sensor,  failed 
stabllator.  or  failed  *pseudO' surface*  a 
combination  of  canards,  ailerons,  arkd  trailing 
sdgs  flaps.  Conclusions  from  this  study 
Indicatsd  that  the  elemental  filters  must  be 
carefully  tuned  to  avoid  masking  of  ‘good* 
versus  *bad*  models.  This  observation  is  mot 
compatible  with  Loop  Transmission  Recovery  (LTR) 
tuning  techniques.  Other  research  efforts 
demonstrated  the  effectiveness  of  the  HMAC 
algorithm  using  seven  elemental  controllers 
designed  for  a  healthy  aircraft,  one  of  threm 
actuator  failures,  or  one  of  threm  sensor 
failures  {10,11)  The  study  included  effects 
of  single  and  double  failures,  and  partial 
failures  as  well  as  hard  failures.  It  also 
demonstrated  the  effectiveness  of  alternate 
techniques  to  resolve  ambiguities  using  modified 
computational  techniques  and  scalar  residual 
monitoring • 

3*  MMAC  and  WAC-Based  Comtrol 

l.«t  a  denote  the  vector  of  uncertain 
paraseter#  in  a  given  linear  stochastic  state 
model  for  a  dynamic  system.  In  this  case 
depicting  the  failure  status  of  sensors  and 
actuators  of  the  aircraft  These  parameters  can 
affect  the  matrices  defining  the  structure  of 
the  model  or  depicting  the  statistics  of  the 
noises  entering  It  In  order  to  make 

simultaneous  estimation  of  states  and  parameters 
tractable.  It  Is  assumed  that  a  can  take  on 
only  one  of  A  discrete  representative  values 
If  we  define  the  hypothesis  conditional 

probability  P^Ctj}  as  the  probability  that  a 
assumes  the  value  (for  k  *  1.3.  .A), 

conditioned  on  the  observed  measurement  history 
to  time  t|; 

p»  ( t  j )  ■  Proi?  [a»a*|  3(ti)-fil  (D 


then  It  can  bm  shown  {1-4)  that  ^ 
evaluated  recursively  for  all  k  via  the 
tteratloo: 
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p«<e,) 


,1 


^5n  ^■(«,ihi.ti«,^i  ^1^*1-%^ 


(2) 


Pki^h  •  -  K^{t^)H,t{t^)P^{t])  (’) 


in  teras  of  ».h«  previous  values  ... 

and  conditional  probability 
densities  for  the  current  eeasureeent  xft|>  to 
be  defined  explicitly  In  Equatloo  (12). 
Notlonally,  the  eeasureaent  history  random 
vector  Z(t^)  is  eade  up  of  partitions 
z(ti),  ^(t^)  that  are  the  eeasurettents 

available  at  the  saeple  tlses 
sisllariy,  the  realization  of  the 

•easurceent  history  vector  has  partitions 
lit  >Z|  Furthermore^  the  ftayeslan  multiple 
model  adaptive  controller  output  Is  the 
probability  weighted  average  (5*7); 

^MSActt,)  •  Ej.l  U»l«,(t*),t(l  p»<ti)  (3) 


Here  ^} .  t  ^  I  is  a  deternlnlstlc  optimal 

full ‘State  teedback  control  law  based  on  the 
assumption  that  the  parameter  vector  equals 
and  is  the  state  estimate  generated  by 

a  Kalman  filter  similarly  based  on  the 
assumption  that  a  -  a^.  If  the  parameter  were 
in  fact  equal  to  ai^.  then  certainty  equivalence 
[5]  would  allow  the  LOO  (Linear  system^ 
Quadratic  cost,  Gaussian  noise)  optimal 
stochastic  control  to  be  generated  as  one  of 
the  t  ^* } .  t  ,J  terms  in  the  summation  of  Cq. 

(3) 

More  explicitly,  let  the  model 
corresponding  to  a^  be  described  by  an 
‘equivalent  d i sc rete * t ime  model  (4,5,11)  for  a 
cont i nuous * t Ime  system  with  sampled  data 
measurements : 

•  ♦  C»(f 

(4> 


£(£,)  ■  (5) 


and  the  propagation  relation: 

•♦»(££. **t(ti)u(tj)  (10) 

•  c»(t()o»(tj)c;(ti) 

The  multiple  model  adaptive  estimation  (MMAE) 
algorithm  ts  composed  of  a  bank  of  JT  separate 
Kalman  filters,  each  based  on  a  particular  value 
a|,..-,ajf  of  the  parameter  vector,  as  depicted 
In  Figure  1.  Instead  of  generating  a  control 
vector  Uj|,  the  HMHE  generates  a  probabilistic- 
ally  weighted  state  estimate  vector,  *retir^ ^ j  * 
These  state  estimates  are  used  by  the  flight 
control  systes  to  generate  the  control  vector 
u^.  Such  HMAE-based  control  is  used  in  this 
research  rather  than  a  I'MAC  because  the 
Incorporation  of  the  full  VISTA  P-IS  flight 
control  system  illustrates  another  step  toward 
the  maturation  of  the  MHAC/HKAC  algorithms. 
When  the  measurement  becomes  available  at 
time  t,,  the  residual  vector  is  generated  in 
each  of  the  K  filters  according  to  the  bracketed 
tern  in  Eq.  (6),  and  used  to  compute 
Pl<t via  Eq.  (2).  Each  numerator 
density  function  in  (2)  Is  given  by  the  Gaussian 
form: 


•  (am)'«^>l*,(e,)|‘^  (12) 

•>«(’) 


!•  )-:-.^r,''(ti)v‘(ti),,(tj>|  (13) 


where  is  the  state,  u  is  a  control  input, 
is  discrete-time  zero-mean  white  Gaussian 
dynamics  noise  of  covariance  at  each  t,, 

z  is  the  measurement  vector.  and  Vj^  is 
d iscrete- t Lme  zero-mean  white  Gaussian 
measurement  noise  of  covariance  xt  t,, 

assumed  independent  of  Wj^;  the  initial  state 
x<'C^;  is  modeled  as  Gaussian,  with  mean  and 
covariance  and  is  assumed  Independent  of  w^^ 
and  v^ .  Bas^  on  this  model,  the  Kalman  filter 
(111  IS  specified  by  the  measurement  update: 

.£»(£/)  •  «»(ti)/’»(£;)w/<tj)  •«»(£<)  (‘> 


*»(£i)  *  P»(£i')«t<'i)*i;‘(£i)  (7) 


f(t‘)  • «»((])  •  )(,(£,)■  \Zi  -  H»{tj)j?,((;)) ,,, 


where  m  is  the  eeasureeent  dimension  and 
Is  calculated  in  the  k-th  Kalman  filter  as  in 
Eq.  (6).  The  denominator  in  Eq.  (2)  Is  sleply 
the  sum  of  all  the  computed  numerator  terms  and 
thus  Is  the  scale  factor  required  to  ensure  that 
the  p^f Cjl's  sum  to  one. 

One  expects  the  residuals  of  the  Kalman 
filter  based  upon  the  ‘best*  model  to  have  mean 
squared  value  most  in  consonance  with  Its  own 
computed  while  ‘mismatched*  filters  will 

have  larger  residuals  than  anticipated  through 
Therefore,  Eqs .  (2),  (3),  and  (6) 

(12)  will  most  heavily  weight  the  filter  based 
upon  the  most  correct  assumed  parameter  value. 
However,  the  performance  of  the  algorithm 
depends  on  there  being  significant  differences 
In  the  characteristics  of  residuals  In  ’correct* 
vs.  ’mismatched*  filters.  Each  filter  should  be 
tuned  for  best  performance  when  the  ’true* 
values  of  the  uncertain  parameters  are  identical 
to  Its  assumed  value  for  these  parameters.  One 
should  specifically  avoid  the  ’conservative* 
philosophy  of  adding  considerable  dynamics 
pseudoDOlse,  often  used  to  guard  against 
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divergence,  since  this  tends  to  sask  the 
differences  between  good  and  bad  eodels. 

3.  Svstea  Modeliaa 

Aerodynawtc  Model  A  slx*degree‘Of ' 
freedoe  nonlinear  aerodynamic  model  provided 
data  to  generate  a  linearized  perturbatioo 
model  utilized  in  this  study  The  data  base 
resides  within  the  Flight  Dynamics  Laboratory 
at  Wright -Patterson  AFB,  Ohio-  The  linearised 
model  Includes  Increments  for  pitch  attitude, 
pitch  rate,  angle  of  attack,  velocity,  roll 
angle,  sideslip  angle,  roll  rate,  and  yaw  rate. 
Normal  and  lateral  accelerations  are  computed. 
Control  effects  are  given  by  left  and  right 
stabllators,  left  and  right  flaperons,  rudder 
and  leading  edge  flaps.  The  model  Is  developed 
with  constant  thrust 

Flight  Control  System  The  flight  control 
system  (FCS)  model  is  a  Fortran  representation 
of  the  visTk  F*l€  FCS.  The  model  4ccurat.ely 
depicts  the  true  system  by  Including 
longitudinal,  lateral,  and  directional 
channels  Each  channel  provides  comiuind  force 
gradients,  command  limiting,  signal  magnitude 
and  rate  limiting  accomplished  within  the 
controller  software,  gain  scheduling,  biases, 
filtering  cha rac ter  1  St ics .  and  true  surface 
poBirion  and  rate  limiting.  Sensor 
measurements  are  corrected  for  position  error 
where  applicable  The  flight  control  system 
requires  seven  sensor  inputs  for  proper 
performance  including:  velocity,  angle  of 
attack,  pitch  rate,  normal  acceleration,  roll 
rate,  yaw  rate,  and  lateral  accelerat Ion . 

The  development  of  a  detailed  model  allovs 
for  a  realistic  evaluation  of  the  HMAE 
algorithm  The  flight  control  system  and 
linearized  aerodynamic  models  were  validated 
separately  and  as  a  system  using  a  six-degree' 
of'freedom  nonlinear  simulation.  Results 
indicated  excellent  correlation  provided  that 
the  constraints  of  the  linear  aerodynamic 
perturbation  model  were  not  violated  Given 
the  short  convergence  times  typical  for  a  fault 
detection  and  isolation  algorithm,  this  Is  not 
a  restrictive  constraint. 


4.  InrlTTitr^lTi 

Hvpotheilied  F,llar«t.  Th«  paraMtar 
spacm,  denoted  by  the  vector  quantity  a,  was 
descretized  into  twelve  hypothesized  hard 
failures:  left  stabliator,  right  stabllator, 

left  flaperon,  right  flaperon,  rudder,  velocity 
sensor,  angle  of  attack  sensor,  pitch  rate 
sensor,  normal  acceleration  sensor,  roll  rate 
sensor,  yaw  rate  sensor,  and  the  lateral 
acceleration  sensor.  Additionally,  the  no* 
failure  aircraft  condition  was  included  to 
provide  an  Initial  system  configuration  prior  to 
failure  transition.  total  or  "hard*  actuator 
failures  are  modeled  by  zeroing  out  the 
appropriate  columns  of  the  control  Input  matrix 
B  of  £q.  (4)  and  hard  sensor  failures  are 

modeled  by  zeroing  out  the  corresponding  rows  of 
the  measurement  matrix  H  of  Eq.  (5). 

Bayesian  Form.  The  final  probability- 
weighted  average  of  the  state  estimates, 
computed  as  shown  in  Figure  1,  Is  produced  by  a 
Bayesian  form  of  the  hMAE  algorithm.  A  Bayesian 
form  of  the  HHAE  algorithm  allows  for  s  blending 
of  filters  designed  for  hard  failures  and  those 
designed  for  no-failures  to  address  partial  or 
soft  failures.  Practical  implementation 

requires  a  lower  bound  when  computing  the 
probabilities  according  to  Eq.  (3).  The 
addition  of  a  lower  bound  prevents  the  algorithm 
from  assigning  any  single  PjgCtt)  a  value  of 
zero,  which  would  prevent  it  from  being 
considered  In  future  probability  co^utatlons. 
From  the  Iterative  nature  of  Eq.  (3),  If 
.}  were  assigned  a  value  of  zero  for  one  of  the 
rllters,  subsequent  probability  calculations  for 
that  filter  would  also  assign  a  probability  of 
zero  (L.e.  p^Ctp  •  0).  The  addition  of  a  lower 
bound  provides  another  favorable  characteristic. 
The  number  of  Iterations  required  to  Increase  a 
very  small,  but  nonzero,  is  directly 

proportional  to  the  magnitude  of  the  pg.  By 
pTovVdlng  a  lower  bound  w«  allow  pg  values, 
previously  not  Important  to  the  combined  state 
estimate,  to  Increase  in  a  timely  mar^oer  if  the 
system  state  changes. 

"Beta  Dominance*  As  discussed  earlier  In 
Section  i,  the  hypothesis  probabilities  Pt(tj) 
are  calculated  according  to  Eq.  (3).  Earlier 
efforts  [3,4,6,10]  noted  that  the  leading 
coefficient  preceding  the  exponential  tern  In 
Eq.  (13)  does  not  provide  any  useful  information 
in  the  Identification  of  the  failure.  As 
discussed  in  Section  3,  che  likelihood  quotient. 

Lt(tj)  ■  t  tl4) 


compares  the  residual  with  the  hypoMieslzed 
filter's  internally  computed  residual 
covariance.  Filters  with  residuals  that  have 
mean  square  values  most  In  consonance  with  their 
internally  computed  covariance  are  assigned  the 
higher  probabilities  by  the  KMAE  algorithm. 
However,  if  the  Ilkellhot^  quotients  were  nearly 
identical  in  magnitude  for  all  k,  the 
probability  computations  would  be  based  upon  the 
magnitude  of  the  determinants  of  the 
matrices,  resulting  In  an  Incorrect  assignment 
of  the  probabilities.  This  effect  Is  known  as 
'Beta  Dominance*.  Because  sensor  failures,  as 
simulated  by  zeroing  out  a  row  of  H,  yield 
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sMlier  valuet.  *bet«  doaioAOC** 
produces  4  tendency  to  generate  fslse  slsras 
sbout  sensor  failures. 

Previous  efforts  resoved  the  tere  preceding 
the  exponent Isl  in  Eq  (12)  Since  the 
denoainstor  of  tq .  (3)  contains  the  sueeatlon 
^f  all  nueerator  teres,  excluding  the  teres 
precedin9  the  exponentials  in  the  calculattoo 
uf  f he  probabilities  does  not  alter  the  fact 
'hat  'he  coeputed  probabilities  sue  to  one. 

Scalar  Residual  Sonitorlnq.  Incorrect  or 
aebiguous  failure  ident I f Lcat ion  eay  be 
resolved  through  the  use  of  scalar  residual 
Monitoring  Eqe  (2).  (12).  and  (11) 
demonstrate  the  relationship  of  the  probability 
ca I cu 1  at  ions .  the  probability  density  function, 
and  the  likelihood  quotient  These  three 
equations  demonstrate  the  dependency  of  the 
probability  calculations  on  the  eagnltude  of 
the  likelihood  quotient.  Eq  (13)-  The 
likelihood  quotient  Is  eerely  the  sum  of  scalar 
*erns  relating  the  product  of  any  two  scalar 
coeponents  of  the  residual  vector  and  the 
filter's  internally  coaputed  covariance  for 
'hose  two  coeponents  If  a  sensor  failure 
occurs.  the  single  scalar  ters  aaaoclated 
solely  with  that  sensor  should  have  a  residual 
value  whose  sagnitude  is  such  larger  than  the 
associated  variance  In  all  of  the  elemental 
filters  except  for  the  filter  designed  to 
'look*  for  that  sensor  failure  Scalar 
residual  eonitorlng  can  be  used  as  an 
additional  vote  when  attempting  to  reduce  or 
elininate  failure  Ident  i  f  IcaC ion  ambiguities. 

Purposeful  Commands .  Failure  detection 
and  isolation  using  the  MHAE  algorithm  requires 
a  stimulus  to  disturb  the  system  from  a 
quiescent  state  The  KMAC  algorithm'* 
performance  depends  upon  the  magnitude  of  the 
residuals  within  incorrect  filters  having  large 
residual  values  Residuals  are  the  difference 
betwc'en  measurements  and  filter  predictions  of 
those  measurements  Incorrect  filters  will 
provide  poor  estimates  relative  to  the  filter 
based  on  the  'true*  system  status  Small 
deviations  from  a  quiescent  state  will  be 
virtually  indistinguishable  fros  system  noise, 
ptoviding  poor  failure  detection  and 
; ien»  j f icat ion  Having  juatlfied  the  need  for 
stimuli  to  'shake  up*  the  system,  ratlonalevas 
developed  to  select  stimuli.  control 
deflections,  and  Improve  performance.  Previous 
efforts  selected  a  pitch  down  maneuver  to  aid 
in  the  identification  process  for  the 
longitudinal  axis  of  an  aircraft  wirh  generally 
favorable  results  (M]  However,  fundamental 
differences  exist  between  earlier  research  and 
'his  effort  Earlier  efforts  concentrated  on 
applying  the  HMAC  algorithm,  evaluating  its 
performance.  and  designing  algorithms  to 
maintain  stability  and  control  la  the 
longitudinal  axis  A  longitudinal  pitch  down 
maneuver  was  sufficient  to  provide  enough 
system  excitation  for  good  performance  A 
three*axis  sophisticated  control  system 
requires  excitation  In  multiple  axes  to  provide 
adequate  residual  growth  In  filters  whose 
hypothesis  does  not  reflect  the  true  system 
failure  status.  The  purposeful  commands  used 
in  this  effort  were  longitudinal  stick  pulls, 
lateral  stick  pulses,  and  varying  amounts  of 
rudder  application.  Ordinary  aircraft 


maneuvering  would  probably  be  more  than 
sufficient  to  provide  adequate  excltatloo  and 
good  performance;  stralght'and'level  flight 
would  be  more  challenging  (though  less  flight 
critical)  for  a  failure  detection  system. 

Autonomous  Dithering.  Autonomous  dithering 
enhances  failure  detection  and  identification  by 
providing  sufficient  excitation  In  benign  non* 
maneuvering  flight  conditions  or  as  a  pilot* 
selectable  option  A  number  of  dither  signals 
were  evaluate,  including  square  waves,  triangle 
waves,  combinations  of  these  forms,  and  sine 
waves.  Pulse  trains  using  a  square  wave  form 
produced  good  performance  with  one  drawback, 
failures  are  not  detected  until  the  application 
of  the  pulse.  Additionally,  pilots  may  find  the 
application  of  a  dither  signal  of  sufficient 
strength  to  provide  good  failure  detection  and 
Isolation  objectionable,  unless  he  were  able  to 
turn  such  dithering  on  and  off  himself 
Sufficient  data  was  not  available  to  relate 
pilot  comments  and  normal  and  lateral 
accelerations  in  this  application,  so  dithers 
were  designed  to  be  as  subliminal  as  possible 
while  yielding  desired  Identlflabllity  of 
failures . 

S.  PerformSBcm 

The  application  of  the  multiple  model 
adaptive  estimation  algorithms  to  the  VISTA  F'lS 
aircraft  In  a  low  dynamic  pressure  case  provided 
an  interesting  test  for  this  technique.  The 
flight  condition,  0.4  Kach  at  an  altitude  of 
30000  ft.,  demonstrated  algorithm  performance  in 
a  low  dynamic  pressure  scenario.  Earlier 
efforts  studied  the  viSTA  F*16  at  s  higher 
dynamic  pressure  and  emphasltmd  different 
failure  scenarios  and  characteristics  (IS);  the 
case  of  low  dynamic  pressure  yields  a  more 
difficult  identification  problem.  The  original 
goal  was  to  evaluate  the  HMAE  algorithm's 
ability  to  detect  and  Isolate  failures  within 
the  flight  control  system  and  not  to  evaluate 
the  ability  of  the  controller  to  malntsto 
control  of  the  vehicle  after  the  identification 
of  the  failure.  An  added  benefit  of  using  the 
VISTA  r*l6  flight  control  system  was  the  absence 
of  any  single* failure* induced  loss  of  control. 
The  figures  presented  in  this  section  are  single 
data  runs  as  opposed  to  Monte  Carlo  runs 
averaged  over  a  number  of  runs,  in  order  to 
exhibit  real-time  signal  characteristics  (Monte 
Carlo  run*  were  used  to  corroborate  performance 
attributes  over  multiple  experimental  trials) 

Purposeful  Commands  Figure  3  demonstrate* 
a  left  atabilator  failure  induced  at  30 
seconds.  A  square  wave  dither  signal  occur*  in 
all  three  channels  every  3  0  second*  beginning 
at  0  seconds  The  pulse  widths  and  magnitudes 
were  different  for  each  channel  and  were 
determined  by  trial  and  error.  Typical  pulse 
cycles,  the  application  of  a  pulse  of  positive 
amplitude  followed  by  the  application  of  a  pulse 
of  negative  amplitude,  were  usually 
approximately  0  3S  seconds.  Figure  3  presents 
performancs  data  after  a  failure  at  3.0  seconds 
and  the  application  of  a  longitudinal  stick  pull 
for  a  duration  of  3.0  aeconds.  starting  at  30 
seconds.  Zt  displays  only  the  no-fallure  and 
failed  actuator  elemental  filter  probabillties; 
the  falled'sensor  elemental  filters  never 
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Attained  any  appreciable  portion  of  the  total 
probability.  The  FT.  Al.  h2,  Al,  A4,  and  AS 
deal^natlona  arc  the  fully  functional  (no 
failure),  left  atabllator.  rl^ht  atabllator/ 
left  flaperon.  rl9ht  flaperon.  and  rudder 
elemental  filters,  respectively.  Tor  the  left 
stabllator  failure  vlth  a  sleultaoeoue 
purposeful  coeeand  of  10  lbs  aft  stick,  the 
al9oriChe  exhibits  a  la^  tiee  of  approxteately 
02  seconds  prior  to  positive  failure 
identification  A  seall  spike  is  evident  In 
the  ri^ht  stabllator  eleeental  filter  during 
the  detection  and  decision  period. 
Occasionally,  aebiqultles  arise  between  the 
left  and  right  stabllator  for  seall  periods  of 
tiee  during  a  stabllator  failure  (purposeful 
roll  rates  could  be  used  to  isolate  which 
stabllator  failed,  once  the  algorlthe  detects 
that  one  of  the  stabllators  has  failed).  Since 
the  left  and  right  stabllators  provide  pitch 
control  and  augeent  the  roll  channel,  the 
identification  task  is  significantly  eore 
difficult  than  that  of  an  actuator  dedicated  to 
a  single  channel  task.  If  the  aircraft  has  a 
roll  angle,  the  surface  positions  of  the  left 
and  right  actuator  eay  not  be  the  saae.  (f  one 
of  the  surface  positions  is  saaller  than  the 
other,  failing  one  surface  say  produce  a 
different  systee  response  froe  falling  the 
other.  The  result  eay  provide  different 
probability  convergence  phenoaena.  The 
solution  it  usually  to  increase  the  purposeful 


coaaand  or  dither  signal  to  a  level  sufficient 
to  produce  proper  syetea  excitation.  However, 
if  the  dither  coaaand  la  too  large,  a  pilot  aay 
object  to  noraal  or  lateral  accelerations  that 
result  froa  coaaande  which  he  did  not  Initiate. 
A  large  purposeful  or  dither  coaaand  aay  reduce 
the  aigoritha  perforaance  by  inducing  large 
transients.  The  Kalaan  filter  gains  within  each 
of  the  eleaental  filtere  are  dealgnad  for  steady 
state  perforaance  The  systea  state  variables 
will  require  a  longer  settling  tlae  as  larger 
aaplltude  transients  are  produced.  Increased 
stick  activity  can  produce  the  saae  effect. 

Figure  3  illustrates  a  left  flaperoo 
failure  induced  at  3.0  seconds.  In  this  failure 
scenario,  a  rudder  application  of  4S  Iba  for  a 
duration  of  30  seconds  coabtnad  with  a 
longitudinal  and  lateral  stick  pulse  deaonstrate 
aigoritha  perforaance.  The  flaperone  are 
control  aurfacea  which  do  not  produce 
significant  changes  In  state  paraaeters  in  a 
short  period  of  tlae.  In  this  casa.  the  failure 
detection  is  identified  in  approxiaately  0.3 
seconds.  Thereafter,  the  aigoritha  atteapts  to 
declare  a  fully  functional  aircraft,  and  finally 
0.6  seconds  later,  positively  Identlflee  that 
failure  as  a  failed  left  flaperon.  During  the 
0.6  second  interval  when  the  left  flaperon  la 
not  selected,  four  filters  share  the  total 
probability.  Including:  fully  functional,  left 
flaperon,  right  flaperon.  and  the  pitch  rate 
eensor  (not  shown).  If  a  lateral  stick  coaaand 
is  Introduced  froa  3  sec  to  6  sac  of  the 
slBulatlon.  the  probability  reaalns  at  the  fully 
functional  filter  until  approxiaately  3.B 
seconds.  At  that  tlae.  the  probability  Is 
transferred  directly  and  entirely  to  the  left 
flaperon  and  reaalns  there  for  the  duration  of 
the  run. 

Figure  4  shows  the  perforaance  of  the 
aigoritha  for  a  rudder  failure  induced  at  3.0 
seconds.  Control  applications  are  given  by  a  46 
lb  rudder  kick  and  hold  for  a  duration  of  3.0 
seconds,  and  a  longitudinal  and  lateral  stick 
pulse.  Results  deaonstrate  a  0.2  second  lag 
between  the  induction  of  the  failure  and 
positive  identification  by  the  proper  eleaental 
filter.  The  *drop  out*  of  the  probability 
during  36  to  3  B  second  Interval  is  gained  by 
the  yaw  rate  sensor  eleaental  filter  (not 
shown) . 

Figure  S  depicts  the  eleaental  filter 
probabilities  (or  the  seven  eleaental  filters 
that  assuae  failed  sensors.  A  pitch  rate 
failure  is  induced  at  30  seconds  while 
siaultaneously  applying  a  longitudinal  coaaand 
of  10  lbs  aft  stick  The  labels  51,  S3.  S3,  S4. 
55.  S6.  and  S7  are  the  sensor  designations  for 
the  velocity,  angle  of  attack,  pitch  rate, 
noraal  acceleration,  roll  rate,  yaw  rate,  and 
lateral  acceleration  eleaental  filters, 
respectively.  In  this  scenario,  the  probability 
is  transferred  directly  froa  the  fully 
functional  filter  (not  shown)  to  the  pitch  rate 
sensor  filter.  S3,  at  the  tlae  of  the  failure. 
The  lag  to  failure  detection  and  Identification 
In  this  case  is  less  than  0  3  seconds.  Sensor 
failures  are  usually  Identified  quickly  due  to 
the  direct  relationship  between  the  variable  the 
sensor  aeasures  and  the  residual  calculation 
upon  which  the  probabilities  are  based. 

In  general,  purposeful  coaaande  aid  In  the 
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Ident t f ieat Ion  procec*  and  often  anhaoc* 
perfornance.  However#  periods  of  lar^e 
aeplitude  or  hlqh  frequency  stick  activity  can 
cause  aeblqultles  and  delay  the  Identlf tcstloo 
process.  Each  ails  eust  be  stleulated  by  a 
control  Input  to  achieve  qood  performance. 
Typical  fllqht  control  eaneuvers  should  be  more 
than  sufficient  to  provide  the  level  of 
eicltatlon  necessary  to  achieve  acceptable 
alqorltha  performance.  Dither  slqoals 
optlBlted  to  provide  qood  failure  detection  and 
Identification  characteristics  can  provide  the 
beat  algorithm  perforaance.  when  used  to 
auqaent  typical  maneuver  Inputs  (l.e.,  dither 
Is  added  to  a  particular  channel  If  the  Input 
connands  do  not  eiclte  that  channel). 


Ldenutlcatlon  of  Failure  In  Benign  . 
Cond it iont for  flight  conditions  wher*  lltt 


control  activity  it  pret«nta  fll9ht  t«f«ty  cso 
be  Maintained  through  the  ute  of  4utoao«04it 
dithering  ai^nalt,  or  pultet.  At  prevloutly 
dencribed  in  thit  tection.  a  dither  signal  Is 
applied  to  each  axis  every  3.0  seconds.  Olther 
signal  aaplitudes  and  frequencies  vere 
artificially  llslted  to  produce  no  eore  than 
*/'  0  05  9's  noreal  acceleration  and  */’  0-1 
9's  lateral  acceleration.  These  restrlctloos 
were  developed  to  allow  a  dither  systee  to  run 
in  the  'background*  during  the  flight  phases 
providing  failure  detection  capability  in 
benign  flight  conditions  The  dither  was 
teeporarlly  disabled  when  a  pilot  coMiaod  was 
Induced  in  that  channel.  Olther  conands  Id 
channels  without  a  pilot  coeeand  were  executed. 

Figure  a  illustrates  a  left  flaperoo 
failure  induced  at  3.0  seconds.  In  this  cases 


the  failure  Is  detected  iDltially  but  sot  locked 
until  approxleatsly  4.1  seconds.  The  *Bisslng* 
probability  was  picked  up  by  the  yaw  rate  filter 
and  the  lateral  acceleration  filter  (not  shown), 
la  this  scenarios  perforeaoce  could  be  enhanced 
by  increasing  the  pulse  aeplitude  of  the  dither 
•  ignal.  Figure  7  doubled  the  rudder  pulse 
aeplitude.  The  correct  failure  was  identified 
in  approxleately  0.14  seconds.  The  lateral 
acceleration  was  approxleately  0.)  g'Ss  probably 
too  large  to  be  undetected  by  a  pilot.  While 
this  dither  say  be  unacceptable  as  a 
*back9round*  dithers  it  is  perfectly  acceptable 
as  a  failure  identification  test.  If  a  pilot 
believed  a  failure  existed  but  could  not 
identify  the  failures  he  would  select  this 
option . 

Figure  •  displays  a  rudder  failure  induced 
at  3.0  seconds.  The  dither  signal  was  not  large 
enough  to  affect  1 seed late  identification.  The 
correct  failure  Is  identified  after  a  delay  of 
approxleately  22  seconds.  The  angle  of  attacks 
pitch  rates  noreal  accelerations  roll  rate,  and 
yaw  rate  sensor  all  contain  soee  portion  of  the 
probability  throughout  the  t'second  run.  This 
suggests  Insufflcisnt  excitation  to  provide  good 
algorlthe  perforaance.  Figure  9  Increases  the 
SDplitude  of  the  rudder  dither  pulse.  In  this 
cases  the  rudder  failure  Is  identified  after  a 
delay  of  approxlaately  0.1  second.  The  notch  In 
the  probability  at  approxleately  4.0  seconds  Is 
due  to  the  application  of  another  dither  pulse. 
This  pulse  shakes  up  the  systee  to  enhance 
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blaa  to  reduc*  to  «  oe^llgiblo  valu«.  Scalar 
raaldual  Booitorlng  provides  positive  evldeoce 
of  a  failure.  This  addltlooal  voter  Is  useful 
is  \he  reductloo  of  asblgultles  lo  actuator 
failures.  Tor  actuator  failures^  Initial 
results  Indicate  that  the  valoclty,  norsal 
acceleration,  yaw  rate,  and  lateral  acceleration 
residuals  provide  the  best  indications  of  a 
failure. 


Identlflablllty.  However,  the  Salman  filters 
were  designed  using  steady  state  gains.  After 
the  application  of  the  dither  pulses,  the 
SYStee  returns  to  a  steady  state  condition  and 
again  the  rudder  Is  Identified  as  the  correct 
failure. 

STK'i'j*! _ Ch,r«ct«rHtlc,.  Flqur*  10 

illustrates  residual  characteristics  for  a  left 
stabllator  failure  Tlgure  10  is  the  velocity 
residual  for  the  elemental  filter  assuelng  a 
left  stabllator  has  failed.  The  velocity 
residual  was  selected  for  display  since  it 
provides  clear  Indications  that  a  failure  has 
occurred  In  this  scenario,  a  constantly 
applied  sine  wave  dither  signal  was  developed 
using  the  normal  and  lateral  acceleration 
criteria  discussed  earlier.  The  frequency  of 
the  dither  was  approximately  3  38  Hs  Prior  to 
the  induction  of  the  failure,  the  residual 
violated  the  3  sigma  bounds  («/*  0.0058 
ft/sec),  appeared  time  correlated  rather  than 
white,  and  the  residual  frequency  matched  the 
dither  frequency  The  3  sigma  bound  is  basmd 
on  the  left  stabllator  elemental  filter's 
Internally  computed  variance  for  the  velocity 
residual.  This  behavior  clearly  Indicates  that 
the  hypothesis  of  a  failed  left  stabllator  Is 
Incorrect  for  the  first  3  sec.  of  the 
staulatlon.  After  the  declaration  of  a  left 
stabllator  failure  at  3.0  seconds,  the  velocity 
residual  appears  more  white  and  moves  within 
the  2  sigma  bounds;  note,  however,  that  it 
takes  about  a  second  for  the  apparent  residual 


«.  lasMix 

A  multiple  model  adaptive  estimation 
algorithm  with  onm  fully  functional,  five 
falled*actuator  and  seven  falled'sensor 
elemental  filters  Illustrates  the  algorithm's 
performaoce  when  applied  to  a  viSTA  f'lt  flight 
control  system  using  s  llnearUmd  aerodynamic 
model.  A  modified  Bayesian  approach  allows  for 
a  blending  of  state  eetlmates  and  provides  lower 
bounds  to  enhance  algorithm  convergence 
properties.  Compensation  for  *Beta  Dominance* 
enhances  algorithm  performance  by  not  allowing 
the  term  preceding  the  exponentiation  in  Eq. 
(13)  to  enter  Into  the  calculations.  This  term 
biases  the  calculation  of  the  probabilities 
toward  the  filter  whose  A||(t|}  matrices  have  the 
smallest  determinants  Scalar  residual 
monitoring  aids  lo  resolving  ambiguities  by 
demonstrating  residual  characteristics 
consistent  with  a  true  failure. 

The  algorithm  demonstrates  good  convergence 
chsrscteristlcs  during  purposeful  commsnde  and 
dither  signals.  Optimising  the  dither  to 
Improve  algorithm  performaoce  is  effective. 
However,  large  dither  signals  cannot  be 
considered  subliminal  and  may  bm  considered 
objectionable  by  a  pilot;  allowing  him  to  turn 
the  dither  on  and  off  may  be  more  useful 
prsctlcslly . 
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